Team_temp / VT2_domc_copy

Dependencies:   mbed-dev

Fork of Adafruit9-DOf_AHRS_Regler_Discrete by RT-Labor IMS

Revision:
3:cc828af4a4c6
Parent:
2:9fd59c70ad78
--- a/Source/MadgwickAHRS.cpp	Thu Oct 19 11:52:10 2017 +0000
+++ b/Source/MadgwickAHRS.cpp	Thu Sep 20 07:43:09 2018 +0000
@@ -254,4 +254,5 @@
     pitch = asinf(-2.0f * (q1*q3 - q0*q2));
     yaw = atan2f(q1*q2 + q0*q3, 0.5f - q2*q2 - q3*q3);
     anglesComputed = 1;
+    Q[0]=q0;Q[1]=q1;Q[2]=q2;Q[3]=q3;
 }
\ No newline at end of file