Added automatic waypoint sequencing