public AStar(int maxNodesToExpand = 1000)
{
frontier = new FastPriorityQueue <INode <T>, T>(maxNodesToExpand);
stateToNode = new Dictionary <T, INode <T> >();
explored = new Dictionary <T, INode <T> >(); // State -> node
createdNodes = new List <INode <T> >(maxNodesToExpand);
}
