public String toString() {
List<Vector2D> anchors = new ArrayList<>(this.size());
for (WeightedWaypoint wp : this) {
anchors.add(wp.computeAnchor());
}
return anchors.toString();
}
public int computeCost() {
int sum = 0;
for (WeightedWaypoint wp : this) {
sum += wp.computeCost();
}
return sum;
}