Add waypoints/cameras as you drive