当解析不出飞控数据时闪红灯

This commit is contained in:
OPTOC
2025-09-04 16:01:12 +08:00
parent 2e5b3416a6
commit bd9ffa3de2
9 changed files with 112 additions and 22 deletions

View File

@@ -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;
}