Files
chest_strap/code/l452_code/packet_parser.py
T
2026-04-24 19:51:22 -07:00

28 lines
721 B
Python

import serial
ser = serial.Serial(port='/dev/ttyACM1', baudrate=115200)
ser.flush()
data = bytes()
ready = False
f = open('data_dump.dat','wb')
for i in range(5):
ser.write(b'R')
data = ser.read(1024)
index = 0
while (index < 1024):
packet_length = (data[index + 1]<<8) + data[index]
packet_type = (data[index + 3]<<8) + data[index + 2]
print(packet_type, packet_length)
if packet_type not in range(1,10):
break
#print(packet_type, packet_length, data[index + 4: index + 4 + packet_length])
index += packet_length + 4
ser.flush()
# if packet_type in [1,2,3,4,5,6,7,8,9] and packet_length > 6:
# dat = ser.read(packet_length)
# print(packet_type, packet_length, dat)