Copter: add rangefinder pre-arm check

This commit is contained in:
Randy Mackay 2015-04-13 13:11:28 +09:00
parent 8ed6207ca8
commit 1ff443d667
1 changed files with 10 additions and 0 deletions

View File

@ -439,6 +439,16 @@ static bool pre_arm_checks(bool display_failure)
}
return false;
}
#if CONFIG_SONAR == ENABLED
// check range finder
if (!sonar.pre_arm_check()) {
if (display_failure) {
gcs_send_text_P(SEVERITY_HIGH,PSTR("PreArm: check range finder"));
}
return false;
}
#endif
}
// if we've gotten this far then pre arm checks have completed