State machine

Dependencies:   mbed Adafruit_GFX BioroboticsMotorControl MODSERIAL BioroboticsEMGFilter

Revision:
46:0be634ee10e8
Parent:
45:f0066593c174
Child:
49:b4fd52d244f9
--- a/main.cpp	Thu Nov 01 17:35:58 2018 +0000
+++ b/main.cpp	Thu Nov 01 17:58:56 2018 +0000
@@ -242,28 +242,28 @@
     if (emg_1_state) {
         led_green = 0;
 
+        if (control_goes_right) {
+            speed_x = max_speed;
+        } else {
+            speed_x = -max_speed;
+        }
+    } else {
+        led_green = 1;
+        speed_x = 0;
+    }
+    
+    if (emg_2_state) {
+        led_blue = 0;
         if (control_goes_up) {
             speed_y = max_speed;
         } else {
             speed_y = -max_speed;
         }
     } else {
-        led_green = 1;
+        led_blue = 1;
         speed_y = 0;
     }
     
-    if (emg_2_state) {
-        led_blue = 0;
-        if (control_goes_right) {
-            speed_x = max_speed;
-        } else {
-            speed_x = -max_speed;
-        }
-    } else {
-        led_blue = 1;
-        speed_x = 0;
-    }
-    
     last_state_1 = emg_1_state;
     last_state_2 = emg_2_state;