started on navigation through waypoints