got all waypoints working