State machine

Dependencies:   mbed Adafruit_GFX BioroboticsMotorControl MODSERIAL BioroboticsEMGFilter

Revision:
32:b63b5837bcb1
Parent:
31:e5b3b01d128a
Child:
50:5d2176b93a65
--- a/end_effector_control.h	Thu Nov 01 13:29:49 2018 +0000
+++ b/end_effector_control.h	Thu Nov 01 14:11:30 2018 +0000
@@ -12,8 +12,8 @@
     
     forward_kinematics(main_current, sec_current, end_x, end_y);
     
-    end_x + move_x;
-    end_y + move_y;
+    end_x += move_x;
+    end_y += move_y;
     
     double main_potential_target, sec_potential_target;