20 "0xF0", "0xF1", "0xF2", "0xF3",
21 "0xE4", "0xE5", "0xE6", "0xE7",
22 "0xD8", "0xD9", "0xDA", "0xDB",
23 "0xCC", "0xCD", "0xCE", "0xCF"
26 def calc_sum(cmd, data):
28 lnh = data_len + 1 & 0xFF00
29 lnl = data_len + 1 & 0x00FF
31 for i in range(data_len):
32 if isinstance(data[i], str):
33 res += int(data[i], 16)
36 res = ~(res - 1) & 0xFF # two's complement
37 return (lnh, lnl, res)
40 # format of data packet is [SOD|LNH|LNL|COM|byte_data|SUM|ETX]
41 def format_command(cmd, data):
45 if isinstance(data, str):
46 byte_data = bytes(data.encode('utf-8'))
48 byte_data = bytes([int(x, 16) for x in data])
50 LNH, LNL, SUM = calc_sum(int(cmd), data)
54 fmt = fmt_header + str(len(data)) + 's' + fmt_footer
55 pack = struct.pack(fmt, SOD, LNH, LNL, COM, byte_data, SUM, ETX)
56 print(fmt, pack, len(pack))
59 # format of data packet is [SOD|LNH|LNL|RES|DAT|SUM|ETX]
60 def format_data(res, data):
62 if (len(data) >= 1024):
63 raise Exception(f'Data packet too large, data length is {DATA_LEN} (>1024)')
64 LNH, LNL, SUM = calc_sum(int(res), data)
65 DAT = bytes([int(x, 16) for x in data])
70 fmt = fmt_header + str(len(data)) + 's' + fmt_footer
71 pack = struct.pack(fmt, SOD, LNH, LNL, RES, DAT, SUM, ETX)
72 print(fmt, pack, len(pack))
74 cmd = format_command(INQ_CMD, "")
76 cmd = format_command(BAU_CMD, ['0x00','0x1E'])
78 cmd = format_command(IDA_CMD, TESTID)
80 format_data(0x13, ['0x00','0x01','0x02'])
81 format_data(0x34, ['0x00'])
82 format_data(0x00, ['0x00'])
83 format_data(0x12, ['0x00'])