State machine
Dependencies: mbed Adafruit_GFX BioroboticsMotorControl MODSERIAL BioroboticsEMGFilter
Diff: main.cpp
- Revision:
- 26:a8f4a117cc0d
- Parent:
- 25:cc81f2120eda
- Child:
- 28:25917b26022c
diff -r cc81f2120eda -r a8f4a117cc0d main.cpp --- a/main.cpp Thu Nov 01 09:10:21 2018 +0000 +++ b/main.cpp Thu Nov 01 10:12:35 2018 +0000 @@ -126,8 +126,8 @@ const double home_x = 0.6524; // Meters. const double home_y = 0.3409; - double main_home = PI *2; - double sec_home = 0; + double main_home; + double sec_home; if(last_state != current_state) { last_state = current_state; @@ -135,7 +135,7 @@ screen.clear_display(); screen.display_state_name("Homing"); - //inverse_kinematics(home_x, home_y, main_home, sec_home); + inverse_kinematics(home_x, home_y, main_home, sec_home); main_motor.set_target_angle(main_home); sec_motor.set_target_angle(sec_home);