diff --git a/libraries/AP_NavEKF/AP_NavEKF.cpp b/libraries/AP_NavEKF/AP_NavEKF.cpp
index 82ff01808d..4bfd3aa29f 100644
--- a/libraries/AP_NavEKF/AP_NavEKF.cpp
+++ b/libraries/AP_NavEKF/AP_NavEKF.cpp
@@ -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