Add waypoints