Fix multipart messaging

Author: AdamSlowik

hal/transport/CAN/MyTransportCAN.cpp

@@ -126,7 +126,7 @@ uint8_t _findCanPacketSlot(long unsigned int from, long unsigned int currentPart
                           ",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) {
+		        packets[i].lastReceivedPart == currentPart) {
 			slot = i;
 		}
 	}
@@ -188,7 +188,7 @@ bool transportSend(const uint8_t to, const void *data, const uint8_t len, const
 		uint8_t partLen;
 		if (len <= 8) {
 			partLen = len;
-		} else if (currentFrame * 8 <= len) {
+		} else if (currentFrame * 8 + 8 <= len) {
 			partLen = 8;
 		} else {
 			partLen = len % 8;
@@ -210,10 +210,11 @@ bool transportSend(const uint8_t to, const void *data, const uint8_t len, const
 		if (sndStat == CAN_OK) {
 			CAN_DEBUG(PSTR("CAN:SND:OK\n"));
 		} else {
-			CAN_DEBUG(PSTR("!CAN:SND:FAIL\n"));
-			return false;
-		}
-	}
+            CAN_DEBUG(PSTR("!CAN:SND:FAIL\n"));
+            return false;
+        }
+    }
+    return true;
 }
 
 bool transportDataAvailable(void)
@@ -238,6 +239,8 @@ bool transportDataAvailable(void)
 		if (currentPart == 0) {
 			slot = _findCanPacketSlot();
 			packets[slot].locked = true;
+			packets[slot].address = from;
+			packets[slot].packetId = messageId;
 		} else {
 			slot = _findCanPacketSlot(from, currentPart, messageId);
 		}