calculate

Dependencies:   mbed X_NUCLEO_IKS01A3 Mahony_Algorithm

Revision:
2:4cccdc792719
Parent:
1:48e219526d0f
Child:
3:795998b31c32
--- a/main.cpp	Mon Apr 13 09:37:17 2020 +0000
+++ b/main.cpp	Wed Apr 15 12:13:15 2020 +0000
@@ -1,4 +1,4 @@
-/**
+            /**
 |**********************************************************************;
 * Project           : Projektarbeit Systemtechnik PES4
 *
@@ -48,10 +48,10 @@
         
         printf("\r\n----------\r\n\n");
         printf("Accelerometer: \t%5.2f\t%5.2f\t%5.2f\r\n",(double)acc[0], (double)acc[1], (double)acc[2]);
-        printf("Speed: \t%5.2f\t%5.2f\t%5.2f\r\n",(speed[0]*9.81)/1000, (speed[1]*9.81)/1000, (speed[2]*9.81)/1000);
-        printf("pos: \t%5.2f\t%5.2f\t%5.2f\r\n",(pos[0]*9.81)/1000, (pos[1]*9.81)/1000, (pos[2]*9.81)/1000);
+        printf("Speed: \t\t%5.2f\t%5.2f\t%5.2f\r\n",(double)speed[0], (double)speed[1], (double)speed[2]);
+        printf("pos: \t\t%5.2f\t%5.2f\t%5.2f\r\n%i",(double)pos[0], (double)pos[1], (double)pos[2], calculate.t);
         printf("\r\n----------\r\n\n");
-        wait_ms(500);
+        wait_ms(1000);
     }
 }