Added priority queue for A* pathfinding. Pathfinding now functional