Implemented first Hangar-Service

Dependencies:   CalibrateMagneto QuaternionMath

Fork of SML2 by TobyRich GmbH

Revision:
16:3e2468d4f4c1
Parent:
15:4488660e1a3b
Child:
17:e9d42864c8a1
--- a/SensorFusion.cpp	Wed Mar 18 15:34:51 2015 +0000
+++ b/SensorFusion.cpp	Fri Mar 20 10:30:01 2015 +0000
@@ -6,7 +6,7 @@
 SensorFusion::SensorFusion(I2C &i2c) : accel(i2c), gyro(i2c), magneto(i2c),
     q(1, 0, 0, 0), // output quaternion
     deltat(0.010), // sec
-    beta(2.6) // correction gain
+    beta(0.5) // correction gain
 {
 }