De hele robot in 1 keer bam

Dependencies:   mbed QEI Servo HIDScope biquadFilter MODSERIAL FastPWM

Revision:
60:762b5c925e13
Parent:
59:57b9d3076930
Child:
61:07035c03cf29
--- a/main.cpp	Fri Nov 01 00:22:16 2019 +0000
+++ b/main.cpp	Fri Nov 01 00:25:45 2019 +0000
@@ -97,7 +97,7 @@
 bool exit_operation = false;
 
 // Demo Substate variables
-enum Demo_States { demo_wait, demo_motor_cal, demo_XY }; // Define demo substates
+enum Demo_States { demo_wait, demo_motor_cal, demo_positioning, demo_XY }; // Define demo substates
 Demo_States demo_curr_state; // Initialize demo substate variable
 bool demo_state_changed = true; // Enable entry functions
 bool exit_demo = false;
@@ -978,7 +978,7 @@
     // State transition guard
     if ( button1_pressed == true ) { // demo_XY
         button1_pressed = false;
-        demo_curr_state = do_demo_positioning;
+        demo_curr_state = demo_positioning;
         demo_state_changed = true;
         // More functions
     } else if ( switch2_pressed == true ) { // Return to global wait
@@ -1017,7 +1017,7 @@
         timerStateChange.reset();
         timerStateChange.start();
     }
-    
+
     Vx = 10.0;
     Vy = 10.0;
 
@@ -1099,6 +1099,9 @@
         case demo_motor_cal:
             do_demo_motor_cal();
             break;
+        case demo_positioning:
+            do_demo_positioning();
+            break;
         case demo_XY:
             do_demo_XY();
             break;