Diff: IMUfilter.cpp
- Revision:
- 2:202906c5fadd
- Parent:
- 1:4b0e8441f099
--- a/IMUfilter.cpp Mon Feb 07 22:02:32 2011 +0000
+++ b/IMUfilter.cpp Sat Feb 12 15:29:40 2011 +0000
@@ -146,7 +146,7 @@
SEq_2 += (SEqDot_omega_2 - (beta * nablaf_2)) * deltat;
SEq_3 += (SEqDot_omega_3 - (beta * nablaf_3)) * deltat;
SEq_4 += (SEqDot_omega_4 - (beta * nablaf_4)) * deltat;
-
+
//Normalise quaternion
norm = sqrt(SEq_1 * SEq_1 + SEq_2 * SEq_2 + SEq_3 * SEq_3 + SEq_4 * SEq_4);
SEq_1 /= norm;