added waypoint manager to autopilot