Implemented first Hangar-Service
Dependencies: CalibrateMagneto QuaternionMath
Fork of SML2 by
Diff: SensorFusion.cpp
- Revision:
- 24:23eae343c631
- Parent:
- 21:5a0c9406e119
- Child:
- 25:abb0f208e6a9
diff -r 48c6a08b5d49 -r 23eae343c631 SensorFusion.cpp --- a/SensorFusion.cpp Fri Apr 10 15:28:31 2015 +0000 +++ b/SensorFusion.cpp Mon Apr 13 14:54:35 2015 +0000 @@ -61,7 +61,7 @@ float const pitch = atan2(2*(q0*q1+q2*q3), 1 - 2*(q1*q1+q2*q2)); float const yaw = atan2(2*(q0*q3+q1*q2), 1 - 2*(q2*q2+q3*q3)); - return Vector3(pitch, roll, yaw) * radian_to_deg; + return Vector3(pitch, roll, yaw); } void SensorFusion::sensorUpdate(Vector3 gyro_degrees)