A* Pathfinding Algorithm in Python