fixed UBX reception

This commit is contained in:
2026-03-17 08:04:11 +01:00
parent b5cd671ed4
commit 63f21de1f5
+5 -4
View File
@@ -28,13 +28,14 @@ class UbxPacketizer(MsgSink, MsgSource):
self.d_save = struct.pack('B', d) self.d_save = struct.pack('B', d)
self.sync_count += 1 self.sync_count += 1
if self.sync_count == len(self.sync_bytes): if self.sync_count == len(self.sync_bytes):
print("UBX-sync")
self.d_save = b''
self.timestamp = msg.timestamp
self.sync_count = 0 self.sync_count = 0
self.d_save = b''
self.packet = b'' self.packet = b''
self.wait_sync = False self.wait_sync = False
self.timestamp = msg.timestamp
print("UBX-sync")
else: else:
self.sync_count = 0
self.packet += self.d_save self.packet += self.d_save
self.d_save = b'' self.d_save = b''
if not self.wait_sync: if not self.wait_sync:
@@ -67,5 +68,5 @@ if __name__ == "__main__":
pkt.register_recv(ubx_rx) pkt.register_recv(ubx_rx)
pkt.reset() pkt.reset()
frame = frame_create(_class=1, _id=2, _data=b'Hallo') + frame_create(_class=1, _id=2, _data=b',') + frame_create(_class=1, _id=2, _data=b'UBX') + frame_create(_class=1, _id=2, _data=b'World') frame = frame_create(_class=1, _id=2, _data=b'Hallo' + b'\xb5' + b',\x62Welt') + frame_create(_class=1, _id=2, _data=b',') + frame_create(_class=1, _id=2, _data=b'UBX') + frame_create(_class=1, _id=2, _data=b'World')
pkt.on_recv(MsgContainer('test', 31101970.0208, frame)) pkt.on_recv(MsgContainer('test', 31101970.0208, frame))