Copter: pre-arm check that gyro cal succeeded

This commit is contained in:
Randy Mackay 2014-10-08 20:17:55 +09:00
parent 834f2bea07
commit 128058362b
1 changed files with 8 additions and 0 deletions

View File

@ -368,6 +368,14 @@ static void pre_arm_checks(bool display_failure)
return;
}
// check gyros calibrated successfully
if(!ins.gyro_calibrated_ok_all()) {
if (display_failure) {
gcs_send_text_P(SEVERITY_HIGH,PSTR("PreArm: Gyro cal failed"));
}
return;
}
#if INS_MAX_INSTANCES > 1
// check all gyros are consistent
if (ins.get_gyro_count() > 1) {