Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 06:28:27 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_GPS: fix UAVCAN gps message handlers

Browse Source
This commit is contained in:
liang.tang 2018-09-04 21:40:06 -07:00 committed by Andrew Tridgell
parent 2c0b9a16a5
commit 7885b267f0
1 changed files with 4 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
libraries/AP_GPS/AP_GPS_UAVCAN.cpp
View File

@ -266,10 +266,9 @@ void AP_GPS_UAVCAN::handle_fix_msg_trampoline(AP_UAVCAN* ap_uavcan, uint8_t node
{
if (take_registry()) {
AP_GPS_UAVCAN* driver = get_uavcan_backend(ap_uavcan, node_id);
if (driver == nullptr) {
return;
if (driver != nullptr) {
driver->handle_fix_msg(cb);
}
driver->handle_fix_msg(cb);
give_registry();
}
}
@ -278,10 +277,9 @@ void AP_GPS_UAVCAN::handle_aux_msg_trampoline(AP_UAVCAN* ap_uavcan, uint8_t node
{
if (take_registry()) {
AP_GPS_UAVCAN* driver = get_uavcan_backend(ap_uavcan, node_id);
if (driver == nullptr) {
return;
if (driver != nullptr) {
driver->handle_aux_msg(cb);
}
driver->handle_aux_msg(cb);
give_registry();
}
}