/** Set the path to be followed. */ @Override public void setPath(Path path) { forward.clear(); this.path.clear(); nav.clearPath(); for (int i = 0; i < path.size(); i++) { forward.add(new Waypoint(path.get(i))); this.path.add(new Waypoint(path.get(i))); } for (int i = path.size() - 2; i > -1; i--) { this.path.add(new Waypoint(path.get(i))); } this.path.add(new Waypoint(0, 0)); for (Waypoint wp : this.path) { nav.addWaypoint(wp); } }