Added a cache in AstarNodeHeap class