src: message: Fix: Checksum split payload_lenght and msg_id into two …

…bytes
bluerobotics · Apr 4, 2024 · 526d3a7 · 526d3a7
1 parent e01764d
commit 526d3a7
Showing 1 changed file with 6 additions and 2 deletions.
diff --git a/src/message.rs b/src/message.rs
@@ -78,8 +78,12 @@ impl ProtocolMessage {
         let mut checksum: u16 = 0;
         checksum += HEADER[0] as u16;
         checksum += HEADER[1] as u16;
-        checksum += self.payload_length;
-        checksum += self.message_id;
+        for &byte in self.payload_length.to_le_bytes().iter() {
+            checksum += byte as u16
+        }
+        for &byte in self.message_id.to_le_bytes().iter() {
+            checksum += byte as u16
+        }
         checksum += self.src_device_id as u16;
         checksum += self.dst_device_id as u16;
         for &byte in &self.payload {