AP_Arming: use prearm_failure_reason()

This commit is contained in:
Andrew Tridgell 2015-09-08 15:50:52 +10:00
parent c10ce3ffbd
commit 7e13edd4c7

View File

@ -144,7 +144,12 @@ bool AP_Arming::ins_checks(bool report)
}
if (!ahrs.healthy()) {
if (report) {
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, PSTR("PreArm: AHRS not healthy!"));
const char *reason = ahrs.prearm_failure_reason();
if (reason) {
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, PSTR("PreArm: %s"), reason);
} else {
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, PSTR("PreArm: AHRS not healthy!"));
}
}
return false;
}