修改 修改寄存器相应帧格式

This commit is contained in:
95384 2024-12-13 13:49:59 +08:00
parent 04d3a7085c
commit 93e48fc389
1 changed files with 9 additions and 7 deletions

View File

@ -1271,16 +1271,18 @@ void FRT_MsgProc_WriteRegister(device_handle device, void *pMsg)
// } // }
// 发回数据 // 发回数据
uint8_t Trans_data[6]; uint8_t Trans_data[8];
Trans_data[0] = g_usrConfigInfo.addr; Trans_data[0] = g_usrConfigInfo.addr;
Trans_data[1] = data[1]; Trans_data[1] = data[1];
Trans_data[2] = start_reg_addr; Trans_data[2] = start_reg_addr >> 8;
Trans_data[3] = reg_num; Trans_data[3] = start_reg_addr;
Trans_data[4] = reg_num >> 8;
Trans_data[5] = reg_num;
return_crc_value = CRC16(Trans_data, 4); return_crc_value = CRC16(Trans_data, 6);
Trans_data[4] = return_crc_value; Trans_data[6] = return_crc_value;
Trans_data[5] = return_crc_value >> 8; Trans_data[7] = return_crc_value >> 8;
uart_dev_write(device, Trans_data, 6); uart_dev_write(device, Trans_data, 8);
for(u_int16_t pos=0; pos <reg_num; pos++) for(u_int16_t pos=0; pos <reg_num; pos++)
{ {