Added A* method, need to determine why the end node will not be placed in the PQ.