修改 修改寄存器相应帧格式
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[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++)
|
||||||
{
|
{
|
||||||
|
|
Loading…
Reference in New Issue