|
|
|
@ -189,13 +189,13 @@ bool AP_Arming::ins_checks(bool report)
@@ -189,13 +189,13 @@ bool AP_Arming::ins_checks(bool report)
|
|
|
|
|
} |
|
|
|
|
if (!ins.get_accel_health_all()) { |
|
|
|
|
if (report) { |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, "PreArm: Accelerometers not healthy"); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, "PreArm: Accels not healthy"); |
|
|
|
|
} |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
if (!ins.accel_calibrated_ok_all()) { |
|
|
|
|
if (report) { |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, "PreArm: 3D accelerometers calibration needed"); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, "PreArm: 3D Accel calibration needed"); |
|
|
|
|
} |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
@ -203,7 +203,7 @@ bool AP_Arming::ins_checks(bool report)
@@ -203,7 +203,7 @@ bool AP_Arming::ins_checks(bool report)
|
|
|
|
|
//check if accelerometers have calibrated and require reboot
|
|
|
|
|
if (ins.accel_cal_requires_reboot()) { |
|
|
|
|
if (report) { |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, "PreArm: Accelerometers calibrated requires reboot"); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, "PreArm: Accels calibrated requires reboot"); |
|
|
|
|
} |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
@ -237,7 +237,7 @@ bool AP_Arming::ins_checks(bool report)
@@ -237,7 +237,7 @@ bool AP_Arming::ins_checks(bool report)
|
|
|
|
|
} |
|
|
|
|
if (AP_HAL::millis() - last_accel_pass_ms[i] > 10000) { |
|
|
|
|
if (report) { |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, "PreArm: Accelerometers inconsistent"); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, "PreArm: Accels inconsistent"); |
|
|
|
|
} |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|