position_estimator_inav: don't change local z on first time ref initialization
Merge branch 'mpc_in_flight_lock' into follower