EKF: Improve height reset function
EKF: Improve height reset function

Add a method to reset the vertical velocity to enable in-flight resets
Reset to GPS height if baro height is not available.

PX4/ecl,PX4/ecl,PX4/ecl,PX4/ecl,PX4/ecl