|
|
|
@ -111,14 +111,14 @@ void AP_Airspeed_UAVCAN::handle_airspeed(AP_UAVCAN* ap_uavcan, uint8_t node_id,
@@ -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() |
|
|
|
|