zhangjianhui/ESPC3-wireless
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

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

Browse Source
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
Download Patch File Download Diff File Expand all files Collapse all files

21
app/drivers/sertrf/protocol/p_protocol.c
View File

@@ -128,10 +128,27 @@ void Protocol_buf_decode(void* data, uint32_t size)
protocol.pro_type = Protocol_buf_search(data, size);
break;
case PROTOCOL_MSP:
msp_recv_buf(&protocol.msp, data, size);
protocol.analysis_sussess_count += msp_recv_buf(&protocol.msp, data, size);
break;
case PROTOCOL_MAVLINK:
mavlink_recv_buf(&protocol.mavlink_device, data, size);
protocol.analysis_sussess_count += mavlink_recv_buf(&protocol.mavlink_device, data, size);
break;
}
}
protocol_status_t get_protocol_status(void)
{
protocol.protocol_status = PROTOCOL_STATUS_OK;
if(protocol.pro_type == PROTOCOL_IDLE)
{
protocol.protocol_status = PROTOCOL_STATUS_TYPE_IDLE;
} else if(protocol.analysis_sussess_count == 0)
{
protocol.protocol_status = PROTOCOL_STATUS_NO_DATA;
}
protocol.analysis_sussess_count = 0;
return protocol.protocol_status;
}