Browse Source

AP_Arming: add ahrs attitude check

mission-4.1.18
Randy Mackay 6 years ago
parent
commit
b805c40bf7
  1. 10
      libraries/AP_Arming/AP_Arming.cpp

10
libraries/AP_Arming/AP_Arming.cpp

@ -325,6 +325,12 @@ bool AP_Arming::ins_checks(bool report) @@ -325,6 +325,12 @@ bool AP_Arming::ins_checks(bool report)
check_failed(ARMING_CHECK_INS, report, "Gyros inconsistent");
return false;
}
// check AHRS attitudes are consistent
if (!AP::ahrs().attitudes_consistent()) {
check_failed(ARMING_CHECK_INS, report, "Attitudes inconsistent");
return false;
}
}
return true;
@ -336,13 +342,13 @@ bool AP_Arming::compass_checks(bool report) @@ -336,13 +342,13 @@ bool AP_Arming::compass_checks(bool report)
// check if compass is calibrating
if (_compass.is_calibrating()) {
check_failed(ARMING_CHECK_COMPASS, report, "Compass calibration running");
check_failed(ARMING_CHECK_NONE, report, "Compass calibration running");
return false;
}
// check if compass has calibrated and requires reboot
if (_compass.compass_cal_requires_reboot()) {
check_failed(ARMING_CHECK_COMPASS, report, "Compass calibrated requires reboot");
check_failed(ARMING_CHECK_NONE, report, "Compass calibrated requires reboot");
return false;
}

Loading…
Cancel
Save