Arsapol Manamunchaiyaporn / Communication_Robot

before test

Fork of Communication_Robot by Betago

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()) {