Test waypoint generation