AP_Arming: prearm check to validate backend read rates against schedu…

…ler loop rate
ArduPilot · Dec 11, 2024 · d30d6f7 · d30d6f7
1 parent c9cc666
commit d30d6f7
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/libraries/AP_Arming/AP_Arming.cpp b/libraries/AP_Arming/AP_Arming.cpp
@@ -484,6 +484,12 @@ bool AP_Arming::ins_checks(bool report)
         }
 #endif
 
+        // check if IMU gyro updates are greater than or equal to Ardupilot Loop rate
+        char fail_msg[MAVLINK_MSG_STATUSTEXT_FIELD_TEXT_LEN+1];
+        if (!ins.pre_arm_check_gyro_backend_rate_hz(fail_msg, ARRAY_SIZE(fail_msg))) {
+            check_failed(ARMING_CHECK_INS, report, "%s", fail_msg);
+            return false;
+        }
     }
 
 #if HAL_GYROFFT_ENABLED