Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

GCS_MAVLink: report airspeed unhealthy when being rejected 

this gives the pilot feedback on airspeed failing EKF innnovation
checks and switching to synthetic airspeed
This commit is contained in:
Andrew Tridgell 2022-01-26 17:37:29 +11:00
parent aab0c31385
commit ab8c40d9bc
1 changed files with 4 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/GCS_MAVLink/GCS.cpp
View File

@ -269,10 +269,12 @@ void GCS::update_sensor_status_flags()
const AP_Airspeed *airspeed = AP_Airspeed::get_singleton();
if (airspeed && airspeed->enabled()) {
control_sensors_present |= MAV_SYS_STATUS_SENSOR_DIFFERENTIAL_PRESSURE;
if (airspeed->use()) {
const bool use = airspeed->use();
const bool enabled = AP::ahrs().airspeed_sensor_enabled();
if (use) {
control_sensors_enabled |= MAV_SYS_STATUS_SENSOR_DIFFERENTIAL_PRESSURE;
}
if (airspeed->all_healthy()) {
if (airspeed->all_healthy() && (!use || enabled)) {
control_sensors_health |= MAV_SYS_STATUS_SENSOR_DIFFERENTIAL_PRESSURE;
}
}