Minor A* bugfix that may improve performance. Work on D Heap and Counter classes to supplant PQueue.