Only use the last waypoint