navigator: skip takeoff if already above takeoff altitude

@DrTon Please do not modify logic you do not fully make out - this change should be reverted, as it violates on-autopilot missions.