Added A* Patthfinding