linghtiin/DebugTool
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

修复raise语句用法;

Browse Source 
添加float数据解析;
更新升级传输方案;
This commit is contained in:
何 泽隆
2024-05-21 20:20:23 +08:00
parent 2582721652
commit 5cf4246338
4 changed files with 80 additions and 37 deletions
Download Patch File Download Diff File Expand all files Collapse all files

63
source/func_frame.py
View File

@@ -1,3 +1,4 @@
import struct
from crc import Calculator, Crc16
from utl import display_hex, trans_list_to_str
@@ -7,11 +8,13 @@ modbus_map = {
# 3 - lnt32
# 4 - str
# 5 - addr
# 6 - float
0x01: ["Hex示例", 1],
0x02: ["Int示例", 2],
0x03: ["Int32示例", 3],
0x04: ["str示例", 4, 16],
0x10: ["addr示例", 5, 6],
0x20: ["Int32示例", 6],
}
@@ -25,11 +28,13 @@ def make_frame_modbus(block:dict):
""" 升级系列报文 """
frame.append(0x07)
if len(block['file']) <= block["header_offset"]:
raise("Modbus Update error, file too small.")
raise Exception("Modbus Update error, file too small.")
if block['step'] == 'start':
frame.append(0x01)
frame.append(0x00)
frame.append(0x00)
frame.append(0x00)
frame.append(block['header_offset'] // 256)
frame.append(block['header_offset'] % 256)
frame += list(block['file'][:block['header_offset']])
@@ -46,8 +51,12 @@ def make_frame_modbus(block:dict):
elif block['step'] == 'end':
frame.append(0x03)
frame.append(0x00)
frame.append(block['index'] // 256)
frame.append(block['index'] % 256)
frame.append(0x00)
frame.append(0x00)
else:
raise("Modbus Update Frame Step Error.")
raise Exception("Modbus Update Frame Step Error.")
else:
""" 数据读取系列报文 """
data_addr = block['data_addr']
@@ -85,19 +94,26 @@ def make_frame_modbus(block:dict):
elif block['type'] == "write_str":
frame.append(0x10)
data_len = len(block['data_val'])
item_len = 2 * block['data_define'][data_addr][2]
data_val = block['data_val']
if data_len > 0x0100:
raise("Modbus data len oversize.")
if data_len > item_len:
raise Exception("Modbus data len oversize.")
elif data_len < item_len:
data_val += '\000' * (item_len - data_len)
data_len = len(data_val)
frame.append(data_addr // 256 % 256)
frame.append(data_addr % 256)
frame.append(0x00)
frame.append(data_len // 2)
frame.append(data_len)
if type(data_val[0]) == str:
data_val = list(map(lambda x: x.encode()[0], data_val))
for i in range(data_len//2):
frame.append(data_val[2*i + 1])
frame.append(data_val[2*i])
else:
raise("Modbus Frame Type Error.")
raise Exception("Modbus Frame Type Error.")
crc = calculator.checksum(bytearray(frame))
@@ -116,7 +132,7 @@ def make_frame_dlt645(block:dict):
data_frame = make_frame_modbus(block["data"])
len_data = len(data_frame)
else:
raise("Unknown dlt645 frame type.")
raise Exception("Unknown dlt645 frame type.")
frame.append(0x68)
frame += block['addr'][:6]
@@ -178,6 +194,11 @@ def display_data(modbus_map: dict, address: int, data: list):
data_len = current_map[2]
item = display_str(data, data_len)
item = trans_list_to_str(item)
elif current_map[1] == 6:
""" 浮点数值表示 """
temp = [data[2], data[3], data[0], data[1]]
item = struct.unpack('>f', bytes(temp))[0]
data_len = 2
if len_max < len(data_label):
len_max = len(data_label)
@@ -193,23 +214,23 @@ def check_frame_modbus(frame, block=None):
""" 校验modbus帧回复 """
calculator = Calculator(Crc16.MODBUS)
if calculator.checksum(frame[:-2]) != (frame[-1] * 0x100 + frame[-2]):
raise("Frame Crc check failed.")
raise Exception("Frame Crc check failed.")
elif frame[0] != 0x01:
raise("Frame device address error.")
raise Exception("Frame device address error.")
code_func = frame[1]
code_subfunc = frame[2]
if code_func == 0x07:
""" 升级回复帧 """
if code_subfunc == 0x01 and frame[3] == 0x00:
return frame[4] * 256 + frame[5]
return frame[6] * 256 + frame[7]
elif code_subfunc == 0x02:
""" 解析帧序号及返回值, 不做序列号校验 """
update_result = frame[3]
update_index = frame[4] * 256 + frame[5]
# 检查严重错误标志
if update_result == 0xFF:
raise("Error, Update abort.")
raise Exception("Error, Update abort.")
if update_result >= 0xA0 or update_result == 0x0F:
check_result = False
else:
@@ -225,7 +246,7 @@ def check_frame_modbus(frame, block=None):
return check_result, update_index, check_hope
elif code_subfunc == 0x03:
if frame[3] == 0xFF:
raise("Update verification failed.")
raise Exception("Update verification failed.")
elif frame[3] == 0x01:
print("Update done.")
elif frame[3] == 0x00:
@@ -234,7 +255,7 @@ def check_frame_modbus(frame, block=None):
print("Update unknown return value.")
return frame[3]
else:
raise("Func code or Return code error.")
raise Exception("Func code or Return code error.")
elif code_func == 0x03 or code_func == 0x04:
""" 数据读取帧 """
if frame[2] == len(frame[3:-2]):
@@ -244,27 +265,27 @@ def check_frame_modbus(frame, block=None):
else:
return list(frame[3:-2])
else:
raise("Frame read error.")
elif code_func == 0x06 and frame[2] == len(frame[3:-2]):
raise Exception("Frame read error.")
elif code_func == 0x06:
""" 单个数据写入帧 """
return frame[13:-4]
elif code_func == 0x10 and frame[2] == len(frame[3:-2]):
return frame[2:-2]
elif code_func == 0x10:
""" 多个数据写入帧 """
return frame[13:-4]
return frame[2:-2]
else:
raise(f"Frame Date error. func={code_func}, func_sub={code_subfunc}, len={len(frame)}")
raise Exception(f"Frame Date error. func={code_func}, func_sub={code_subfunc}, len={len(frame)}")
def check_frame_dlt645(frame, block=None):
""" 校验dlt645帧回复 """
if sum(frame[:-2]) % 0x100 != frame[-2]:
raise("DLT645 Frame Verify error.")
raise Exception("DLT645 Frame Verify error.")
elif len(frame[10:-2]) != frame[9]:
raise("DLT645 Frame len error.")
raise Exception("DLT645 Frame len error.")
code_func = frame[8]
if code_func == 0x9F:
block = block['data']
return check_frame_modbus(frame[10:-2], block)
else:
raise("DLT645 Frame type error.")
raise Exception("DLT645 Frame type error.")