public virtual Vector3[] Apply (GraphNode[] path, Vector3 start, Vector3 end, int startIndex, int endIndex, NavGraph graph) {
Vector3[] p = new Vector3[endIndex-startIndex];
for (int i=startIndex;i< endIndex;i++) {
p[i-startIndex] = (Vector3)path[i].position;
}
return p;
}