State machine
Dependencies: mbed Adafruit_GFX BioroboticsMotorControl MODSERIAL BioroboticsEMGFilter
Diff: main.cpp
- 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;