Implemented first Hangar-Service
Dependencies: CalibrateMagneto QuaternionMath
Fork of SML2 by
Diff: Accelerometer.cpp
- Revision:
- 9:a0ae9e68f95d
- Parent:
- 8:cba37530d480
- Child:
- 11:d21275e60ebb
diff -r cba37530d480 -r a0ae9e68f95d Accelerometer.cpp --- a/Accelerometer.cpp Wed Feb 18 15:13:41 2015 +0000 +++ b/Accelerometer.cpp Tue Feb 24 10:06:17 2015 +0000 @@ -58,6 +58,10 @@ f.bytes[4] = read_reg(0x06) >> 4; f.bytes[5] = read_reg(0x07); + f.values.x /= 16; + f.values.y /= 16; + f.values.z /= 16; + const float accel_resolution = 0.0009765625; return Vector3(f.values.x, f.values.y, f.values.z) * accel_resolution;