Routing through waypoints