fix: consider endianess for uint16_t payload length

vtx22 · Mar 9, 2025 · 504412a · 504412a
1 parent 51deba7
commit 504412a
Showing 1 changed file with 9 additions and 1 deletion.
diff --git a/src/sparq_types.hpp b/src/sparq_types.hpp
@@ -91,7 +91,15 @@ struct sparq_message_header_t
     {
         signature = buffer[0];
         control = buffer[1];
-        payload_length = (buffer[2] << 8) + buffer[3];
+        if ((bool)(control & (uint8_t)sparq_header_control_t::LSB_FIRST) == sparq_is_little_endian())
+        {
+            payload_length = (buffer[2] << 8) + buffer[3];
+        }
+        else
+        {
+            payload_length = (buffer[3] << 8) + buffer[2];
+        }
+
         checksum = buffer[4];
     }