diff --git a/ArduCopter/GCS_Mavlink.pde b/ArduCopter/GCS_Mavlink.pde index 6dc344785d..01ac407a57 100644 --- a/ArduCopter/GCS_Mavlink.pde +++ b/ArduCopter/GCS_Mavlink.pde @@ -206,7 +206,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; }