Biorobotics 7 / Mbed 2 deprecated State_Machine

State machine

Dependencies:   mbed Adafruit_GFX BioroboticsMotorControl MODSERIAL BioroboticsEMGFilter

Diff: main.cpp

Revision:
26:a8f4a117cc0d
Parent:
25:cc81f2120eda
Child:
28:25917b26022c
--- 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);