GetClosestWaypoint converted to xyz_location