moved clear_waypoints_service call