Implemented first Hangar-Service

Dependencies:   CalibrateMagneto QuaternionMath

Fork of SML2 by TobyRich GmbH

Revision:
24:23eae343c631
Parent:
21:5a0c9406e119
Child:
25:abb0f208e6a9
--- 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)