seperate height EKF from INSEKF