}
return node;
}
public static boolean isSameNode(PathNode a, PathNode b) {
HPoint3 p = a.getPosition();
HPoint3 q = b.getPosition();
double epsilon = MathUtil.MACHINE_EPSILON;
return (p.isPoint() == q.isPoint())
&& MathUtil.equal(p.x(), q.x(), epsilon)
&& MathUtil.equal(p.y(), q.y(), epsilon)
&& MathUtil.equal(p.z(), q.z(), epsilon);
}