started adding UBX protocol

This commit is contained in:
2026-03-16 08:34:58 +01:00
parent d044e35901
commit 6ee3e68fe7
+26
View File
@@ -0,0 +1,26 @@
import struct
def checksum(data: bytes) -> bytes:
ck_a = 0
ck_b = 0
for i in range(len(data)):
ck_a = (ck_a + data[i]) & 0xFF
ck_b = (ck_b + ck_a) & 0xFF
return struct.pack("BB", ck_a, ck_b)
def frame_create(msg_class: int, msg_id: int, payload: bytes) -> bytes:
hdr = b'\xb5\x62'
frame = struct.pack('B', msg_class)
frame += struct.pack('B', msg_id)
frame += struct.pack('<H', len(payload))
frame += payload
check = checksum(frame)
return hdr + payload + check
if __name__ == "__main__":
result = frame_create(1, 2, b'Hallo')
print(result)