M9 Biorobotics Group 8 / Mbed 2 deprecated CARD_program

De hele robot in 1 keer bam

Dependencies:   mbed QEI Servo HIDScope biquadFilter MODSERIAL FastPWM

Diff: main.cpp

Revision:
49:80970a03083b
Parent:
46:8a8fa8e602a1
Child:
50:86bad994f08f
--- a/main.cpp	Thu Oct 31 14:37:21 2019 +0000
+++ b/main.cpp	Thu Oct 31 14:45:14 2019 +0000
@@ -1098,7 +1098,13 @@
     // Entry function
     if ( global_state_changed == true ) {
         global_state_changed = false;
-        // More functions
+        
+        if ( motor_cal_done == true ) {
+            demo_curr_state = demo_wait;
+        } else if (motor_cal_done == false ) {
+            demo_curr_state = demo_motor_cal;
+        }
+        demo_state_changed = true;
     }
 
     // Do stuff until end condition is met