Motor control for robotic arm
Dependencies: MCP23017 WattBob_TextLCD mbed
Fork of Balanced Arm by
Diff: PC_Comms/PC_Comms.cpp
- Revision:
- 20:d93f0af76c7a
- Parent:
- 19:bf64727d5b0e
- Child:
- 21:ab49231d1479
diff -r bf64727d5b0e -r d93f0af76c7a PC_Comms/PC_Comms.cpp --- a/PC_Comms/PC_Comms.cpp Thu Feb 11 16:37:02 2016 +0000 +++ b/PC_Comms/PC_Comms.cpp Mon Feb 15 15:22:58 2016 +0000 @@ -124,23 +124,24 @@ void PC_Comms::PC_WritePosition(char _servo){ -// char _returnToPC[4]; -// int pos_data; + char _returnToPC[4]; + int pos_data; + + pos_data = my_AX12.GetPosition(); + _returnToPC[0] = 'S'; + _returnToPC[1] = 'D'; + _returnToPC[2] = '1'; + _returnToPC[3] = _servo; + + if(pos_data >= 1000){ + _PCbus.printf("%s%i",_returnToPC, 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); + } +} // -// pos_data = my_AX12.GetPosition(); -// _returnToPC[0] = 'S'; -// _returnToPC[1] = 'D'; -// _returnToPC[2] = '1'; -// _returnToPC[3] = _servo; -// -// 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 +//void PC_Comms::PC_Human \ No newline at end of file