Implemented first Hangar-Service
Dependencies: CalibrateMagneto QuaternionMath
Fork of SML2 by
Diff: SensorFusion.cpp
- Revision:
- 44:5483079fa156
- Parent:
- 43:6251c0169f4f
diff -r 6251c0169f4f -r 5483079fa156 SensorFusion.cpp --- 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; +}