TRR 2018 / Mbed 2 deprecated biniou-TRR2019-DLVV

Dependencies:   mbed MPU6050

Revision:
2:e9d928fd327a
Parent:
1:8faddee0e52f
Child:
3:1b7eb426247e
--- a/main.cpp	Sat Sep 28 22:29:57 2019 +0000
+++ b/main.cpp	Sat Sep 28 22:58:02 2019 +0000
@@ -1,4 +1,5 @@
 #include "sm_esc.h"
+#include "sm_servo.h"
 
 int main() {
 
@@ -9,11 +10,14 @@
     pc.printf("init state machines");
     
     init_sm_esc();
-    
+    init_sm_servo();
+
     while(1) {
 
         update_sm_esc();
+        update_sm_servo();
         
         output_sm_esc();
+        output_sm_servo();
     }
 }