Add debug messages

Author: AdamSlowik

hal/transport/CAN/MyTransportCAN.cpp

@@ -122,6 +122,9 @@ uint8_t _findCanPacketSlot(long unsigned int from, long unsigned int currentPart
 	uint8_t slot = CAN_BUF_SIZE;
 	uint8_t i;
 	for (i = 0; i < CAN_BUF_SIZE; i++) {
+        CAN_DEBUG(PSTR("CAN:RCV:LCK=%" PRIu8 ",ADDR=%" PRIu8
+                          ",PACK_ID=%" PRIu8 ",LAST_PART=%" PRIu8 "\n"), packets[i].locked, packets[i].address, packets[i].packetId,
+                  packets[i].lastReceivedPart);
 		if (packets[i].locked && packets[i].address == from && packets[i].packetId == messageId &&
 		        packets[i].lastReceivedPart == currentPart + 1) {
 			slot = i;
@@ -206,7 +209,6 @@ bool transportSend(const uint8_t to, const void *data, const uint8_t len, const
 		                               partLen, buff);
 		if (sndStat == CAN_OK) {
 			CAN_DEBUG(PSTR("CAN:SND:OK\n"));
-			return true;
 		} else {
 			CAN_DEBUG(PSTR("!CAN:SND:FAIL\n"));
 			return false;
@@ -228,6 +230,10 @@ bool transportDataAvailable(void)
 		               ",TOTAL=%"PRIu32",CURR=%"PRIu32",TO=%"PRIu32",FROM=%"PRIu32"\n"), rxId, messageId,
 		          totalPartCount,
 		          currentPart, to, from);
+        CAN_DEBUG(PSTR("CAN:RCV:LN=%" PRIu8 ",DTA0=%" PRIu8 ",DTA1=%" PRIu8 ",DTA2=%" PRIu8 ",DTA3=%" PRIu8
+                          ",DTA4=%" PRIu8 ",DTA5=%" PRIu8 ",DTA6=%" PRIu8 ",DTA7=%" PRIu8 "\n"), len, rxBuf[0],
+                  rxBuf[1],
+                  rxBuf[2], rxBuf[3], rxBuf[4], rxBuf[5], rxBuf[6], rxBuf[7]);
 		uint8_t slot;
 		if (currentPart == 0) {
 			slot = _findCanPacketSlot();