mission: takeoff and next waypoint related fixes