Biorobotics 7 / Mbed 2 deprecated State_Machine

State machine

Dependencies:   mbed Adafruit_GFX BioroboticsMotorControl MODSERIAL BioroboticsEMGFilter

Diff: main.cpp

Revision:
24:e1092f95c82b
Parent:
23:fb681b074a92
Child:
25:cc81f2120eda
diff -r fb681b074a92 -r e1092f95c82b main.cpp
--- a/main.cpp	Thu Nov 01 08:20:36 2018 +0000
+++ b/main.cpp	Thu Nov 01 08:40:10 2018 +0000
@@ -154,8 +154,8 @@
     const double home_x = 0.6524; // Meters.
     const double home_y = 0.3409;
     
-    double main_home;
-    double sec_home;
+    double main_home = PI *2;
+    double sec_home = 0;
     
     if(last_state != current_state) {
         last_state = current_state;
@@ -163,7 +163,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);