Diff: ButtonService.h

Revision:

10:f5cd99dd9efa

Parent:

9:e265a634306d

Child:

11:03a4a6e9f27c

--- a/ButtonService.h	Fri Oct 20 18:28:34 2017 +0000
+++ b/ButtonService.h	Fri Oct 20 19:01:23 2017 +0000
@@ -59,9 +59,27 @@
         copy(pitchValue, pitchValue + 4, result + 4);
         copy(yawValue, yawValue + 4, result + 8);
         
-        copy(gxValue, gxValue + 2, result + 12);
-        copy(gyValue, gyValue + 2, result + 14);
-        copy(gzValue, gzValue + 2, result + 16);
+        //copy(gxValue, gxValue + 2, result + 12);
+        //copy(gyValue, gyValue + 2, result + 14);
+        //copy(gzValue, gzValue + 2, result + 16);
+        
+        uint8_t gxLowerValue = gx & 0xff;
+        uint8_t gxHighValue = gx >> 8
+        
+        uint8_t gyLowerValue = gy & 0xff;
+        uint8_t gyHighValue = gy >> 8
+        
+        uint8_t gzLowerValue = gz & 0xff;
+        uint8_t gzHighValue = gz >> 8
+        
+        result[13] = gxLowerValue;
+        result[14] = gxHighValue;
+        
+        result[15] = gyLowerValue;
+        result[16] = gyHighValue;
+        
+        result[17] = gzLowerValue;
+        result[18] = gzHighValue;
                 
         ble.gattServer().write(buttonState.getValueHandle(), (uint8_t *)result, sizeof(result));
     }