Added remove functionality to PriorityQueue, aStar now correctly removes nodes with same state but lower priority from the priority queue