Implemented Initial Version of A* PathFinding