maedalab / Mbed 2 deprecated MPU9250_AHRS

Dependencies:   MPU9250_SPI mbed

Revision:
29:6075f35f472f
Parent:
27:7dd32c696d17
Child:
30:a1bbb934b053
--- a/MadgwickAHRS.h	Wed Jul 06 10:02:49 2016 +0000
+++ b/MadgwickAHRS.h	Wed Jul 06 11:44:22 2016 +0000
@@ -43,11 +43,11 @@
     float qDot1, qDot2, qDot3, qDot4;
     float hx, hy;
     float _2q0mx, _2q0my, _2q0mz, _2q1mx, _2bx, _2bz, _4bx, _4bz, _2q0, _2q1, _2q2, _2q3, _2q0q2, _2q2q3, q0q0, q0q1, q0q2, q0q3, q1q1, q1q2, q1q3, q2q2, q2q3, q3q3;
-
-    printf("%f %f %f ",gx,gy,gz);
-    printf("%f %f %f ",ax,ay,az);
-    printf("%f %f %f ",mx,my,mz);
-    printf("\n");
+/*
+    printf("%+4.3f %+4.3f %+4.3f  ",gx,gy,gz);
+    printf("%+4.3f %+4.3f %+4.3f  ",ax,ay,az);
+    printf("%.3f %.3f %.3f ",mx,my,mz);
+    printf("\n");*/
     // Use IMU algorithm if magnetometer measurement invalid (avoids NaN in magnetometer normalisation)
     if((mx == 0.0f) && (my == 0.0f) && (mz == 0.0f)) {
         updateIMU(gx, gy, gz, ax, ay, az);