Added sending waypoint commands the to autopilot.