Motor control for robotic arm

Dependencies:   MCP23017 WattBob_TextLCD mbed

Fork of Balanced Arm by Balanced Arm

Revision:
19:bf64727d5b0e
Parent:
18:b79a9a7cf5fb
Child:
20:d93f0af76c7a
--- a/PC_Comms/PC_Comms.cpp	Tue Feb 09 14:59:12 2016 +0000
+++ b/PC_Comms/PC_Comms.cpp	Thu Feb 11 16:37:02 2016 +0000
@@ -112,36 +112,35 @@
     _returnToPC[3] = _servo;
     
     if(load_data >= 1000){
-    _PCbus.printf("%s%i",_returnToPC, load_data);
-    }else if(load_data > 1000 && load_data >= 100){
-        _PCbus.printf("%s0%i", _returnToPC, load_data);
-    }else if(load_data> 1000 && load_data >= 10){
-        _PCbus.printf("%s00%i", _returnToPC, load_data);
-    }else{
-        _PCbus.printf("%s000%i", _returnToPC, load_data);
+    _PCbus.printf("%s%d\n",_returnToPC, load_data);
+    }else if(load_data < 1000 && load_data >= 100){
+        _PCbus.printf("%s0%d\n", _returnToPC, load_data);
+    }else if(load_data < 100 && load_data >= 10){
+        _PCbus.printf("%s00%d\n", _returnToPC, load_data);
+    }else if(load_data < 10){
+        _PCbus.printf("%s000%d\n", _returnToPC, load_data);
     }
 }
 
-
-
 void PC_Comms::PC_WritePosition(char _servo){
     
-//    char _returnToPC_pos[4];
+//    char _returnToPC[4];
 //    int pos_data;
 //
 //       pos_data = my_AX12.GetPosition();
-//    _returnToPC_pos[0] = 'S';
-//    _returnToPC_pos[1] = 'D';
-//    _returnToPC_pos[2] = '1';
-//    _returnToPC_pos[3] = _servo;
+//    _returnToPC[0] = 'S';
+//    _returnToPC[1] = 'D';
+//    _returnToPC[2] = '1';
+//    _returnToPC[3] = _servo;
 //    
-////    if(pos_data >= 1000){
-//    _PCbus.printf("%s%i",_returnToPC_pos, pos_data);
-////    }else if(pos_data > 1000 && pos_data >= 100){
-////        _PCbus.printf("%s0%i", _returnToPC_pos, pos_data);
-////    }else if(pos_data> 1000 && pos_data >= 10){
-////        _PCbus.printf("%s00%i", _returnToPC_pos, pos_data);
-////    }else{
-////        _PCbus.printf("%s000%i", _returnToPC_pos, pos_data);
-////    }
+//     if(pos_data >= 1000){
+//    _PCbus.printf("%s%i",_returnToPC, pos_data);
+//    lcd->printf("%i",pos_data);
+//    }else if(pos_data < 1000 && pos_data >= 100){
+//        _PCbus.printf("%s0%i\n", _returnToPC, pos_data);
+//    }else if(pos_data < 100 && pos_data >= 10){
+//        _PCbus.printf("%s00%i\n", _returnToPC, pos_data);
+//    }else{
+//        _PCbus.printf("%s000%i\n", _returnToPC, pos_data);
+//    }
 }
\ No newline at end of file