AP_NavEKF : Fix bug that leaves height unconstrained in static mode

11 years ago · 6ace31b6c1
1 changed files with 1 additions and 1 deletions
--- a/libraries/AP_NavEKF/AP_NavEKF.cpp
+++ b/libraries/AP_NavEKF/AP_NavEKF.cpp
@ -618,7 +618,7 @@ void NavEKF::SelectVelPosFusion()
				@@ -618,7 +618,7 @@ void NavEKF::SelectVelPosFusion()
        // we only fuse position and height in static mode
        fuseVelData = false;
        fusePosData = true;
-        fusePosData = true;
+        fuseHgtData = true;
    }

    // Perform fusion if conditions are met