当解析不出飞控数据时闪红灯
This commit is contained in:
@@ -179,10 +179,11 @@ void mavlink_recv_loop(mavlink_device_t* mavlink_device)
|
||||
}
|
||||
}
|
||||
|
||||
void mavlink_recv_buf(mavlink_device_t* mavlink_device, void *data, uint32_t size)
|
||||
int mavlink_recv_buf(mavlink_device_t* mavlink_device, void *data, uint32_t size)
|
||||
{
|
||||
uint8_t res = 0;
|
||||
bool success = false;
|
||||
|
||||
|
||||
mavlink_message_t message;
|
||||
|
||||
uint32_t size_lat = size;
|
||||
@@ -196,8 +197,9 @@ void mavlink_recv_buf(mavlink_device_t* mavlink_device, void *data, uint32_t siz
|
||||
if(success){
|
||||
// printf("Received message from serial with ID #%d (sys:%d|comp:%d):\n", message.msgid, message.sysid, message.compid);
|
||||
mavlik_packet_processing(mavlink_device,&message);
|
||||
// break;
|
||||
success = false;
|
||||
res++;
|
||||
}
|
||||
}
|
||||
|
||||
return res;
|
||||
}
|
||||
Reference in New Issue
Block a user