Added A* Pathfinding algorithm