Copter: arming check that throttle is above failsafe

This commit is contained in:
Randy Mackay 2013-11-02 14:06:19 +09:00
parent aaf642c223
commit 977983904f
1 changed files with 9 additions and 1 deletions

View File

@ -389,10 +389,18 @@ static bool pre_arm_gps_checks()
static bool arm_checks(bool display_failure)
{
// succeed if arming checks are disabled
if(!g.arming_check_enabled) {
if (!g.arming_check_enabled) {
return true;
}
// check throttle is above failsafe throttle
if (g.failsafe_throttle != FS_THR_DISABLED && g.rc_3.radio_in < g.failsafe_throttle_value) {
if (display_failure) {
gcs_send_text_P(SEVERITY_HIGH,PSTR("Arm: Thr below FS"));
}
return false;
}
// check gps is ok if required - note this same check is also done in pre-arm checks
if (mode_requires_GPS(control_mode) && !pre_arm_gps_checks()) {
if (display_failure) {