A* Pathfinding with binary heaps