Got waypoint_list_service working