AP_NavEKF : Fix bug that leaves height unconstrained in static mode

This bug results in significant height and height rate transients in EKF after arming in Copter.