Implement the A* pathfinding algorithm on a 2D grid.