calculate

Dependencies:   mbed X_NUCLEO_IKS01A3 Mahony_Algorithm

Files at this revision

API Documentation at this revision

Comitter:
zollecy1
Date:
Fri May 01 08:44:21 2020 +0000
Parent:
5:62994bb9fff9
Commit message:
..

Changed in this revision

CalculateData.cpp Show annotated file Show diff for this revision Revisions of this file
diff -r 62994bb9fff9 -r 4641f2b2684b CalculateData.cpp
--- 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]);
 }