Waypoints working.