fixed UBX reception
This commit is contained in:
@@ -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))
|
||||||
|
|||||||
Reference in New Issue
Block a user