mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-02-23 16:23:56 -04:00
Plane: only report ahrs unhealthy after initialisation
This commit is contained in:
parent
799f559c1d
commit
b17c6d3368
@ -215,7 +215,7 @@ static NOINLINE void send_extended_status1(mavlink_channel_t chan)
|
|||||||
MAV_SYS_STATUS_SENSOR_DIFFERENTIAL_PRESSURE);
|
MAV_SYS_STATUS_SENSOR_DIFFERENTIAL_PRESSURE);
|
||||||
control_sensors_health |= MAV_SYS_STATUS_GEOFENCE;
|
control_sensors_health |= MAV_SYS_STATUS_GEOFENCE;
|
||||||
|
|
||||||
if (!ahrs.healthy()) {
|
if (ahrs.initialised() && !ahrs.healthy()) {
|
||||||
// AHRS subsystem is unhealthy
|
// AHRS subsystem is unhealthy
|
||||||
control_sensors_health &= ~MAV_SYS_STATUS_AHRS;
|
control_sensors_health &= ~MAV_SYS_STATUS_AHRS;
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user