diff --git a/ArduCopter/GCS_Mavlink.pde b/ArduCopter/GCS_Mavlink.pde index bcda5e9695..318d215467 100644 --- a/ArduCopter/GCS_Mavlink.pde +++ b/ArduCopter/GCS_Mavlink.pde @@ -213,7 +213,7 @@ static NOINLINE void send_extended_status1(mavlink_channel_t chan) control_sensors_health &= ~MAV_SYS_STATUS_SENSOR_3D_ACCEL; } - if (!ahrs.healthy()) { + if (ahrs.initialised() && !ahrs.healthy()) { // AHRS subsystem is unhealthy control_sensors_health &= ~MAV_SYS_STATUS_AHRS; }