AP_Vehicle: add instructions for config_error loop

4 years ago · 5f8b4968ec
1 changed files with 5 additions and 1 deletions
--- a/libraries/AP_Vehicle/AP_Vehicle.cpp
+++ b/libraries/AP_Vehicle/AP_Vehicle.cpp
@ -206,7 +206,11 @@ void AP_Vehicle::scheduler_delay_callback()
				@@ -206,7 +206,11 @@ void AP_Vehicle::scheduler_delay_callback()
    }
    if (tnow - last_5s > 5000) {
        last_5s = tnow;
-        gcs().send_text(MAV_SEVERITY_INFO, "Initialising ArduPilot");
+        if (AP_BoardConfig::in_config_error()) {
+            gcs().send_text(MAV_SEVERITY_CRITICAL, "Config Error: fix problem then reboot");
+        } else {
+            gcs().send_text(MAV_SEVERITY_INFO, "Initialising ArduPilot");
+        }
    }

    logger.EnableWrites(true);