Diff: CalculateData.cpp

Revision:

6:4641f2b2684b

Parent:

5:62994bb9fff9

--- a/CalculateData.cpp	Wed Apr 29 10:54:59 2020 +0000
+++ b/CalculateData.cpp	Fri May 01 08:44:21 2020 +0000
@@ -177,7 +177,7 @@
         mahony->getEuler();
         transform(array_acc, i, acc, mahony->getRoll(), mahony->getPitch(), mahony->getYaw());
         
-        //filterAcc(acc);
+        filterAcc(acc);
         
         integrate(acc, acc_old, speed, t[i], t_old); //in mm/s
         
@@ -192,8 +192,8 @@
         t_old=t[i];
     }
     counter = 0;
-    //printf("Roll:\t%i\tPitch:\t%i\tYaw:\t%i\r\n",mahony->getRoll(),mahony->getPitch(),mahony->getYaw());
-    printf("%f, %f, %f, %f, %f, %f, %f\r\n",acc[0],acc[1],acc[2], t_old/1000.0f, speed[0]/1000.0f,speed[1]/1000.0f,speed[2]/1000.0f);
+    printf("Roll:\t%i\tPitch:\t%i\tYaw:\t%i\r\n",mahony->getRoll(),mahony->getPitch(),mahony->getYaw());
+    //printf("%f, %f, %f, %f, %f, %f, %f\r\n",acc[0],acc[1],acc[2], t_old/1000.0f, speed[0]/1000.0f,speed[1]/1000.0f,speed[2]/1000.0f);
     //printf("%f, %f, %f\r\n",acc[0],acc[1],acc[2]);
 }