修改 修改寄存器相应帧格式
This commit is contained in:
parent
04d3a7085c
commit
93e48fc389
|
@ -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[1] = data[1];
|
||||
Trans_data[2] = start_reg_addr;
|
||||
Trans_data[3] = reg_num;
|
||||
Trans_data[2] = start_reg_addr >> 8;
|
||||
Trans_data[3] = start_reg_addr;
|
||||
Trans_data[4] = reg_num >> 8;
|
||||
Trans_data[5] = reg_num;
|
||||
|
||||
return_crc_value = CRC16(Trans_data, 4);
|
||||
Trans_data[4] = return_crc_value;
|
||||
Trans_data[5] = return_crc_value >> 8;
|
||||
uart_dev_write(device, Trans_data, 6);
|
||||
return_crc_value = CRC16(Trans_data, 6);
|
||||
Trans_data[6] = return_crc_value;
|
||||
Trans_data[7] = return_crc_value >> 8;
|
||||
uart_dev_write(device, Trans_data, 8);
|
||||
|
||||
for(u_int16_t pos=0; pos <reg_num; pos++)
|
||||
{
|
||||
|
|
Loading…
Reference in New Issue