Simple step tracking

Dependencies:   MPU9250 mbed-os

Fork of ST by alonso palomino

Revision:
11:03a4a6e9f27c
Parent:
10:f5cd99dd9efa
--- a/ButtonService.h	Fri Oct 20 19:01:23 2017 +0000
+++ b/ButtonService.h	Sun Oct 22 14:47:11 2017 +0000
@@ -59,27 +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 gxLowerValue = gx & 0xff;
+        //uint8_t gxHighValue = gx >> 8
         
-        uint8_t gyLowerValue = gy & 0xff;
-        uint8_t gyHighValue = gy >> 8
+        //uint8_t gyLowerValue = gy & 0xff;
+        //uint8_t gyHighValue = gy >> 8
         
-        uint8_t gzLowerValue = gz & 0xff;
-        uint8_t gzHighValue = gz >> 8
+        //uint8_t gzLowerValue = gz & 0xff;
+        //uint8_t gzHighValue = gz >> 8
         
-        result[13] = gxLowerValue;
-        result[14] = gxHighValue;
+        //result[13] = gxLowerValue;
+        //result[14] = gxHighValue;
         
-        result[15] = gyLowerValue;
-        result[16] = gyHighValue;
+        //result[15] = gyLowerValue;
+        //result[16] = gyHighValue;
         
-        result[17] = gzLowerValue;
-        result[18] = gzHighValue;
+        //result[17] = gzLowerValue;
+        //result[18] = gzHighValue;
                 
         ble.gattServer().write(buttonState.getValueHandle(), (uint8_t *)result, sizeof(result));
     }