diff --git a/libraries/AP_Airspeed/AP_Airspeed_UAVCAN.cpp b/libraries/AP_Airspeed/AP_Airspeed_UAVCAN.cpp index 31ba23e5e1..1d2dcc0e6b 100644 --- a/libraries/AP_Airspeed/AP_Airspeed_UAVCAN.cpp +++ b/libraries/AP_Airspeed/AP_Airspeed_UAVCAN.cpp @@ -111,14 +111,14 @@ void AP_Airspeed_UAVCAN::handle_airspeed(AP_UAVCAN* ap_uavcan, uint8_t node_id, { WITH_SEMAPHORE(_sem_registry); - AP_Airspeed_UAVCAN* driver = get_uavcan_backend(ap_uavcan, node_id); + AP_Airspeed_UAVCAN* driver = get_uavcan_backend(ap_uavcan, node_id); - if (driver != nullptr) { - WITH_SEMAPHORE(driver->_sem_airspeed); - driver->_pressure = cb.msg->differential_pressure; - driver->_temperature = cb.msg->static_air_temperature - C_TO_KELVIN; - driver->_last_sample_time_ms = AP_HAL::millis(); - } + if (driver != nullptr) { + WITH_SEMAPHORE(driver->_sem_airspeed); + driver->_pressure = cb.msg->differential_pressure; + driver->_temperature = cb.msg->static_air_temperature - C_TO_KELVIN; + driver->_last_sample_time_ms = AP_HAL::millis(); + } } bool AP_Airspeed_UAVCAN::init()