Implemented first Hangar-Service

Dependencies:   CalibrateMagneto QuaternionMath

Fork of SML2 by TobyRich GmbH

Revision:
44:5483079fa156
Parent:
43:6251c0169f4f
--- a/SensorFusion.cpp	Wed May 27 11:45:00 2015 +0000
+++ b/SensorFusion.cpp	Fri May 29 12:21:31 2015 +0000
@@ -256,3 +256,14 @@
     q.v.z = q4 * norm;
 }
 
+void SensorFusion6::calibrate(){
+    gyro.calibrate();    
+}
+
+void SensorFusion6::reset(){
+    gyro.reset();
+}
+
+bool SensorFusion6::isGyroCalibrated(){
+    return gyro.isCalibrated;    
+}