Motor control for robotic arm
Dependencies: MCP23017 WattBob_TextLCD mbed
Fork of Balanced Arm by
Diff: PC_Comms/PC_Comms.cpp
- 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