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

…bytes
bluerobotics · Apr 4, 2024 · 19283de · 19283de
1 parent e01764d
commit 19283de
Showing 1 changed file with 8 additions and 2 deletions.
diff --git a/src/message.rs b/src/message.rs
@@ -78,8 +78,14 @@ 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;
+        self.payload_length
+            .to_le_bytes()
+            .iter()
+            .for_each(|byte| checksum += *byte as u16);
+        self.message_id
+            .to_le_bytes()
+            .iter()
+            .for_each(|byte| checksum += *byte as u16);
         checksum += self.src_device_id as u16;
         checksum += self.dst_device_id as u16;
         for &byte in &self.payload {