v2
Fork of Communication_Robot by
Diff: communication.cpp
- Revision:
- 13:bc19774be4df
- Parent:
- 6:2ed7945594db
--- a/communication.cpp Sun Jun 05 09:43:16 2016 +0000 +++ b/communication.cpp Tue Jun 07 03:14:19 2016 +0000 @@ -8,6 +8,7 @@ uint8_t COMMUNICATION::sendCommunicatePacket(ANDANTE_PROTOCOL_PACKET *packet) { + uint8_t currentParameter = 0; bool isWholePacket = false; uint8_t encoderState = WAIT_ON_HEADER_0; @@ -16,8 +17,14 @@ Timer timer; timer.start(); +#ifdef ANDANTE_DEBUG + pc->printf("Write: %d ", ANDANTE_PROTOCOL_COMMAND_RESPONSE_TIMEOUT_MS); +#endif while((timer.read_ms() < ANDANTE_PROTOCOL_COMMAND_RESPONSE_TIMEOUT_MS) && (!isWholePacket)) { + + pc->printf("Write: %d ", ANDANTE_PROTOCOL_COMMAND_RESPONSE_TIMEOUT_MS); + if( serialCom->writeable()) {