|
|
|
@ -109,7 +109,8 @@ void AP_AHRS_NavEKF::update_EKF1(void)
@@ -109,7 +109,8 @@ void AP_AHRS_NavEKF::update_EKF1(void)
|
|
|
|
|
if (start_time_ms == 0) { |
|
|
|
|
start_time_ms = AP_HAL::millis(); |
|
|
|
|
} |
|
|
|
|
if (AP_HAL::millis() - start_time_ms > startup_delay_ms) { |
|
|
|
|
// slight extra delay on EKF1 to prioritise EKF2 for memory
|
|
|
|
|
if (AP_HAL::millis() - start_time_ms > startup_delay_ms + 100) { |
|
|
|
|
ekf1_started = EKF1.InitialiseFilterDynamic(); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|