navigator: skip takeoff if already above takeoff altitude

In case of transition from "MISSION (with finished mission)" to e.g. "RTL" we can reuse current setpoint as "previous". For MC it worked before bacause previous setpoint was simply ignored. (Changes related to mpc_track branch)