Pathfinding using A* algorithm