Motor control for robotic arm

Dependencies:   MCP23017 WattBob_TextLCD mbed

Fork of Balanced Arm by Balanced Arm

Revision:
15:fb0de6376f8a
Parent:
14:3be8ca0c066d
Child:
16:585f8b5abc2c
diff -r 3be8ca0c066d -r fb0de6376f8a PC_Comms/PC_Comms.cpp
--- a/PC_Comms/PC_Comms.cpp	Wed Feb 03 13:58:54 2016 +0000
+++ b/PC_Comms/PC_Comms.cpp	Wed Feb 03 14:10:51 2016 +0000
@@ -78,16 +78,16 @@
             switch(Command[2])
             {
                 case '0':
-                    char angle[3];
-                    angle[0] = Command[4];
-                    angle[1] = Command[5];
-                    angle[2] = Command[6];
-                    int angle2 = atoi(angle);
-                    lcd->cls();
-                    lcd->printf("%i", angle2);
-                    wait(1);
-                    my_AX12.SetGoal(angle2);
-                    break;
+//                    char angle[3];
+//                    angle[0] = Command[4];
+//                    angle[1] = Command[5];
+//                    angle[2] = Command[6];
+//                    int angle2 = atoi(angle);
+//                    lcd->cls();
+//                    lcd->printf("%i", angle2);
+//                    wait(1);
+//                    my_AX12.SetGoal(angle2);
+//                    break;
                 default:
                     break;
             }
@@ -109,10 +109,10 @@
     lcd->cls();
     lcd->printf("%i", data);
     wait(5);
-    _returnToPC[0] = 'S';
-    _returnToPC[1] = 'D';
-    _returnToPC[2] = '0';
-    _returnToPC[3] = _servo;
+//    _returnToPC[0] = 'S';
+//    _returnToPC[1] = 'D';
+//    _returnToPC[2] = '0';
+//    _returnToPC[3] = _servo;
 //    _returnToPC[4] = '0';
 //    _returnToPC[5] = '0';
 //    _returnToPC[6] = '0';