diff --git a/libraries/AP_Arming/AP_Arming.cpp b/libraries/AP_Arming/AP_Arming.cpp index c22a1916b9..eaf766e334 100644 --- a/libraries/AP_Arming/AP_Arming.cpp +++ b/libraries/AP_Arming/AP_Arming.cpp @@ -365,8 +365,9 @@ bool AP_Arming::ins_accels_consistent(const AP_InertialSensor &ins) last_accel_pass_ms = now; } + // if accels can in theory be inconsistent, // must pass for at least 10 seconds before we're considered consistent: - if (now - last_accel_pass_ms < 10000) { + if (ins.get_accel_count() > 1 && now - last_accel_pass_ms < 10000) { return false; } @@ -389,8 +390,9 @@ bool AP_Arming::ins_gyros_consistent(const AP_InertialSensor &ins) last_gyro_pass_ms = now; } + // if gyros can in theory be inconsistent, // must pass for at least 10 seconds before we're considered consistent: - if (now - last_gyro_pass_ms < 10000) { + if (ins.get_gyro_count() > 1 && now - last_gyro_pass_ms < 10000) { return false; }