public void SetEndWaypoint(Waypoint w) { Waypoint[] newpath = WaypointManager.FindPathToWaypoint(path[curwaypointindex], w, FindObjectOfType <WaypointManager>().visited.ToArray()); if (newpath == null) { Debug.Log("Path not valid, continuing on current path"); return; } Debug.Log("Changing path"); path = newpath; curwaypointindex = 0; }