TRR 2018 / Mbed 2 deprecated biniou-TRR2019-DLVV

Dependencies:   mbed MPU6050

Revision:
9:1b54bac6d9a7
Parent:
8:f23601373e8b
Child:
11:2156cb77d0d6
diff -r f23601373e8b -r 1b54bac6d9a7 main.cpp
--- a/main.cpp	Wed Oct 02 22:25:12 2019 +0000
+++ b/main.cpp	Thu Oct 03 23:28:56 2019 +0000
@@ -9,7 +9,7 @@
 {
     //on met le jumper sur le chassis le plus récent. Avec le jumper, b_CHASSIS_Mode = 0.
     init_chassis_mode();
-   
+
     //init timers
     t_utils_timerSinceStart.start();
 
@@ -19,7 +19,7 @@
     b_UTILS_emergency_signal.rise(&it_emergency_signal_recieved);
 
     //init state machines
-    rs_UTILS_pc.printf("init state machines\r\n");
+    rs_LOG_pc.printf("init state machines\r\n");
 
     init_sm_mpu();
     init_sm_sections();
@@ -27,7 +27,8 @@
     init_sm_servo();
 
     while(1) {
-        
+        rs_LOG_pc.printf("\r\n\r\nTIME: %d\r\n",t_utils_timerSinceStart.read_ms());
+
         update_sm_mpu();
         update_sm_sections();
         update_sm_esc();
@@ -38,6 +39,5 @@
         output_sm_esc();
         output_sm_servo();
         
-        rs_UTILS_pc.printf("\r\n");
     }
 }