From ff9917d3388723aa3d6af6d9759fb1a5e96489cb Mon Sep 17 00:00:00 2001
From: Paul Riseborough <p_riseborough@live.com.au>
Date: Tue, 7 Apr 2015 16:37:50 +1000
Subject: [PATCH] AP_AHRS: Fix bug preventing EKF from initialising

---
 libraries/AP_AHRS/AP_AHRS_NavEKF.cpp | 5 ++---
 1 file changed, 2 insertions(+), 3 deletions(-)

diff --git a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp
index de56b9e369..10c9074ade 100644
--- a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp
+++ b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp
@@ -81,9 +81,8 @@ void AP_AHRS_NavEKF::update(void)
         if (start_time_ms == 0) {
             start_time_ms = hal.scheduler->millis();
         }
-        if (hal.scheduler->millis() - start_time_ms > startup_delay_ms &&
-            EKF.InitialiseFilterDynamic()) {
-            ekf_started = true;
+        if (hal.scheduler->millis() - start_time_ms > startup_delay_ms) {
+            ekf_started = EKF.InitialiseFilterDynamic();
         }
     }
     if (ekf_started) {