Added A* Shortest Path Algorithm