当解析不出飞控数据时闪红灯
This commit is contained in:
@@ -466,21 +466,23 @@ void msp_recv_loop(msp_port_t *msp)
|
||||
}
|
||||
}
|
||||
}
|
||||
void msp_recv_buf(msp_port_t *msp, void *data, uint32_t size)
|
||||
int msp_recv_buf(msp_port_t *msp, void *data, uint32_t size)
|
||||
{
|
||||
uint8_t res = 0;
|
||||
uint32_t size_lat = size;
|
||||
uint8_t* data_char = (uint8_t*)data;
|
||||
|
||||
while (size_lat --)
|
||||
{
|
||||
uint8_t c = data_char[size - size_lat - 1];
|
||||
uint8_t c = data_char[size - size_lat - 1];
|
||||
if (msp_parse_received_data(msp, c))
|
||||
{
|
||||
if (msp->c_state == MSP_COMMAND_RECEIVED)
|
||||
{
|
||||
msp_process_received_command(msp);
|
||||
// break;
|
||||
res ++;
|
||||
}
|
||||
}
|
||||
}
|
||||
return res;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user