class
AStarNode
IWaypoint
advance(int skip)
getCurrentWaypoint()
getNextWaypoint()
next()
void
setPath(IWaypoint firstWaypoint, org.joml.Vector3d startPosition)