diff --git a/APMrover2/GCS_Mavlink.cpp b/APMrover2/GCS_Mavlink.cpp index 735214eaa8..0b4bbf8f4f 100644 --- a/APMrover2/GCS_Mavlink.cpp +++ b/APMrover2/GCS_Mavlink.cpp @@ -313,6 +313,7 @@ bool GCS_MAVLINK_Rover::try_send_message(enum ap_message id) // wants to fire then don't send a mavlink message. We want to // prioritise the main flight control loop over communications if (!hal.scheduler->in_delay_callback() && + !AP_BoardConfig::in_sensor_config_error() && rover.scheduler.time_available_usec() < 200) { gcs().set_out_of_time(true); return false;