330 lines
12 KiB
Python
330 lines
12 KiB
Python
from crc import Calculator, Crc16
|
|
from utl import display_hex, trans_list_to_str
|
|
|
|
modbus_map = {
|
|
# 1 - Hex
|
|
# 2 - Int16
|
|
# 3 - lnt32
|
|
# 4 - str
|
|
# 5 - addr
|
|
0x0E: ["故障字1", 1],
|
|
0x0F: ["故障字2", 1],
|
|
0x10: ["MPPT工作状态", 1],
|
|
0x11: ["系统工作状态", 1],
|
|
0x12: ["系统工作模式", 1],
|
|
0x13: ["输入电压", 2],
|
|
0x14: ["电感电流", 2],
|
|
0x15: ["12V电压", 2],
|
|
0x16: ["输出电压", 2],
|
|
0x17: ["输入电流", 2],
|
|
0x18: ["温度1", 2],
|
|
0x19: ["温度2", 2],
|
|
0x1A: ["输入功率", 3],
|
|
0x1C: ["设备温度", 2],
|
|
0x1D: ["开关机状态", 1],
|
|
0x1E: ["保留", 1],
|
|
0x1F: ["保留", 1],
|
|
|
|
0x60: ["光伏通道使能", 1],
|
|
0x61: ["最小启动输入电压", 2],
|
|
0x62: ["最大启动输入电压", 2],
|
|
0x63: ["最小停止输入电压", 2],
|
|
0x64: ["最大停止输入电压", 2],
|
|
0x65: ["最小MPPT电压", 2],
|
|
0x66: ["最大MPPT电压", 2],
|
|
0x67: ["最小启动输出电压", 2],
|
|
0x68: ["最大启动输出电压", 2],
|
|
0x69: ["最小停止输出电压", 2],
|
|
0x6A: ["最大停止输出电压", 2],
|
|
0x6B: ["输入过压保护值", 2],
|
|
0x6C: ["输出过压保护值", 2],
|
|
0x6D: ["输出欠压保护值", 2],
|
|
0x6E: ["电感过流保护值", 2],
|
|
0x6F: ["输入过流保护值", 2],
|
|
0x70: ["最小电感电流限值", 2],
|
|
0x71: ["最大电感电流限值", 2],
|
|
0x72: ["浮充电压阈值", 2],
|
|
0x73: ["三点法中间阈值", 2],
|
|
0x74: ["恒压充电电压", 2],
|
|
0x75: ["过温故障值", 2],
|
|
0x76: ["过温告警值", 2],
|
|
0x77: ["温度恢复值", 2],
|
|
0x78: ["最低满载电压", 2],
|
|
0x79: ["最高满载电压", 2],
|
|
0x7A: ["输入过载保护值", 3],
|
|
0x7C: ["最小功率限值", 3],
|
|
0x7E: ["最大功率限值", 3],
|
|
0x80: ["最大功率限值存储值", 3],
|
|
0x82: ["载波通信地址", 5],
|
|
0x85: ["电压环out_max", 2],
|
|
0x86: ["电压环out_min", 2],
|
|
0x87: ["电流环out_max", 2],
|
|
0x88: ["电流环out_min", 2],
|
|
0x89: ["MPPT扰动系数k_d_vin", 2],
|
|
0x8A: ["dmin", 2],
|
|
0x8B: ["dmax", 2],
|
|
0x8C: ["扫描电压偏移scanvolt_offset", 2],
|
|
0x8D: ["电压环Kp", 3],
|
|
0x8F: ["电压环Ki", 3],
|
|
0x91: ["电流环Kp", 3],
|
|
0x93: ["电流环Ki", 3],
|
|
0x95: ["日志级别", 1],
|
|
0x96: ["日志输出方式", 1],
|
|
0x97: ["采样校准volt_in_a", 2],
|
|
0x98: ["采样校准volt_in_b", 2],
|
|
0x99: ["采样校准volt_out_a", 2],
|
|
0x9A: ["采样校准volt_out_b", 2],
|
|
0x9B: ["采样校准curr_in_a", 2],
|
|
0x9C: ["采样校准curr_in_b", 2],
|
|
0x9D: ["采样校准curr_induc_a", 2],
|
|
0x9E: ["采样校准curr_induc_b", 2],
|
|
0x9F: ["采样校准volt_12V_a", 2],
|
|
0xA0: ["采样校准volt_12V_b", 2],
|
|
0xA1: ["温度补偿temp1_b", 2],
|
|
0xA2: ["温度补偿temp2_b", 2],
|
|
0xA3: ["系统工作模式", 2],
|
|
0xA4: ["电感电流给定值curr_set", 2],
|
|
0xA5: ["抖动频率上限", 2],
|
|
0xA6: ["抖动频率下限", 2],
|
|
0xA7: ["保留", 1],
|
|
0xA8: ["保留", 1],
|
|
0xA9: ["保留", 1],
|
|
0xAA: ["保留", 1],
|
|
0xAB: ["保留", 1],
|
|
0xAC: ["保留", 1],
|
|
0xAD: ["保留", 1],
|
|
0xAE: ["保留", 1],
|
|
0xAF: ["保留", 1],
|
|
0x100: ["版本", 4],
|
|
0x110: ["型号", 4],
|
|
}
|
|
|
|
|
|
def make_frame_modbus(block:dict):
|
|
""" modbus 生成函数"""
|
|
frame = []
|
|
calculator = Calculator(Crc16.MODBUS)
|
|
|
|
frame.append(block['addr_dev'])
|
|
if block['type'] == 'update':
|
|
""" 升级系列报文 """
|
|
frame.append(0x07)
|
|
if len(block['file']) <= block["header_offset"]:
|
|
raise("Modbus Update error, file too small.")
|
|
|
|
if block['step'] == 'start':
|
|
frame.append(0x01)
|
|
frame.append(0x00)
|
|
frame.append(block['header_offset'] // 256)
|
|
frame.append(block['header_offset'] % 256)
|
|
frame += list(block['file'][:block['header_offset']])
|
|
elif block['step'] == 'trans':
|
|
file_offset = block["header_offset"] + block['index'] * block['file_block_size']
|
|
file_block = block['file'][file_offset: file_offset + block['file_block_size']]
|
|
frame.append(0x02)
|
|
frame.append(0x00)
|
|
frame.append(block['index'] // 256)
|
|
frame.append(block['index'] % 256)
|
|
frame.append(len(file_block) // 256)
|
|
frame.append(len(file_block) % 256)
|
|
frame += list(file_block)
|
|
elif block['step'] == 'end':
|
|
frame.append(0x03)
|
|
frame.append(0x00)
|
|
else:
|
|
raise("Modbus Update Frame Step Error.")
|
|
else:
|
|
""" 数据读取系列报文 """
|
|
data_addr = block['data_addr']
|
|
if block['type'] == "read":
|
|
frame.append(0x03)
|
|
data_len = block['data_len']
|
|
frame.append(data_addr // 256 % 256)
|
|
frame.append(data_addr % 256)
|
|
frame.append(data_len // 256 % 256)
|
|
frame.append(data_len % 256)
|
|
elif block['type'] == "write_one":
|
|
frame.append(0x06)
|
|
data_val = block['data_val']
|
|
if data_val < 0:
|
|
data_val += 0x1_0000
|
|
frame.append(data_addr // 256 % 256)
|
|
frame.append(data_addr % 256)
|
|
frame.append(data_val // 256 % 256)
|
|
frame.append(data_val % 256)
|
|
elif block['type'] == "write_dual":
|
|
frame.append(0x10)
|
|
data_val = block['data_val']
|
|
if data_val < 0:
|
|
data_val += 0x1_0000_0000
|
|
frame.append(data_addr // 256 % 256)
|
|
frame.append(data_addr % 256)
|
|
frame.append(0x00)
|
|
frame.append(0x02)
|
|
frame.append(0x04)
|
|
frame.append(data_val // 256 % 256)
|
|
frame.append(data_val % 256)
|
|
data_val //= 0x1_0000
|
|
frame.append(data_val // 256 % 256)
|
|
frame.append(data_val % 256)
|
|
elif block['type'] == "write_str":
|
|
frame.append(0x10)
|
|
data_len = len(block['data_val'])
|
|
data_val = block['data_val']
|
|
if data_len > 0x0100:
|
|
raise("modbus data len oversize.")
|
|
frame.append(data_addr // 256 % 256)
|
|
frame.append(data_addr % 256)
|
|
frame.append(0x00)
|
|
frame.append(data_len // 2)
|
|
frame.append(data_len)
|
|
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.")
|
|
|
|
|
|
crc = calculator.checksum(bytearray(frame))
|
|
frame.append(crc % 256)
|
|
frame.append(crc // 256)
|
|
|
|
return frame
|
|
|
|
def make_frame_dlt645(block:dict):
|
|
""" dlt645 生成函数"""
|
|
frame = []
|
|
|
|
if block['type'] == 'modbus':
|
|
""" Modbus 透传帧 """
|
|
ctrl_code = 0x1F # Modbus 透传帧功能码
|
|
data_frame = make_frame_modbus(block["data"])
|
|
len_data = len(data_frame)
|
|
else:
|
|
raise("Unknown dlt645 frame type.")
|
|
|
|
frame.append(0x68)
|
|
frame += block['addr'][:6]
|
|
frame.append(0x68)
|
|
frame.append(ctrl_code)
|
|
frame.append(len_data)
|
|
frame += data_frame
|
|
frame.append(sum(frame) % 256)
|
|
frame.append(0x16)
|
|
|
|
return frame
|
|
|
|
def display_data(address: int, data: list):
|
|
""" 格式化表示数据 """
|
|
def display_str(data, len_data):
|
|
item = bytearray(data[:2 * len_data])
|
|
for i in range(len_data):
|
|
t = item[2*i]
|
|
item[2*i] = item[2*i+1]
|
|
item[2*i+1] = t
|
|
return item
|
|
|
|
output = "Parse Result: \n"
|
|
idx = address
|
|
len_max = 0
|
|
while data:
|
|
if idx not in modbus_map.keys():
|
|
output_line = "\t Error, doesn`t match item.\n"
|
|
output += output_line
|
|
break
|
|
|
|
len_data = 1
|
|
current_map = modbus_map[idx]
|
|
if current_map[1] == 1:
|
|
""" Hex字符表示 """
|
|
item = data[0] * 0x0100 + data[1]
|
|
item = display_hex(item, 4)
|
|
elif current_map[1] == 2:
|
|
""" 16位数值表示 """
|
|
item = data[0] * 0x0100 + data[1]
|
|
if item > 0x8000:
|
|
item -= 0x1_0000
|
|
elif current_map[1] == 3:
|
|
""" 32位数值表示 """
|
|
item = data[2] * 0x0100 + data[3]
|
|
item *= 0x10000
|
|
item += data[0] * 0x0100 + data[1]
|
|
if data[2] > 0x80:
|
|
item -= 0x1_0000_0000
|
|
len_data = 2
|
|
elif current_map[1] == 4:
|
|
""" 字符串表示 """
|
|
len_data = 16
|
|
item = display_str(data, len_data)
|
|
item = item.decode()
|
|
elif current_map[1] == 5:
|
|
""" 载波地址表示 """
|
|
len_data = 3
|
|
item = display_str(data, len_data)
|
|
item = trans_list_to_str(item)
|
|
|
|
if len_max < len(current_map[0]):
|
|
len_max = len(current_map[0])
|
|
len_remain = len_max - len(current_map[0])
|
|
output_line = "\t".join([display_hex(idx, 4), current_map[0] + " " * len_remain, str(item)])
|
|
|
|
idx += len_data
|
|
del data[0:len_data * 2]
|
|
output += output_line + "\n"
|
|
return output
|
|
|
|
def check_frame_modbus(frame, block=None):
|
|
""" 校验modbus帧回复 """
|
|
calculator = Calculator(Crc16.MODBUS)
|
|
if calculator.checksum(frame[:-2]) != (frame[-1] * 0x100 + frame[-2]):
|
|
raise Exception("Frame Crc check failed.")
|
|
elif frame[0] != 0x01:
|
|
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]
|
|
elif code_subfunc == 0x02 and frame[3] == 0x00:
|
|
update_index = frame[4] * 256 + frame[5]
|
|
if type(block) is dict and block['index'] != update_index:
|
|
raise Exception("Error slave response.")
|
|
return update_index
|
|
elif code_subfunc == 0x03 and frame[3] == 0x00:
|
|
return frame[4] * 256 + frame[5]
|
|
elif code_func == 0x03 or code_func == 0x04:
|
|
""" 数据读取帧 """
|
|
if frame[2] == len(frame[3:-2]):
|
|
if type(block) is dict:
|
|
data_addr = block['data_addr']
|
|
return display_data(data_addr, list(frame[3:-2]))
|
|
else:
|
|
return list(frame[3:-2])
|
|
else:
|
|
raise("Frame read error.")
|
|
elif code_func == 0x06 and frame[2] == len(frame[3:-2]):
|
|
""" 单个数据写入帧 """
|
|
return frame[13:-4]
|
|
elif code_func == 0x10 and frame[2] == len(frame[3:-2]):
|
|
""" 多个数据写入帧 """
|
|
return frame[13:-4]
|
|
else:
|
|
raise(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 Exception("DLT645 Frame Verify error.")
|
|
elif len(frame[10:-2]) != frame[9]:
|
|
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 Exception("DLT645 Frame type error.")
|
|
|