Finished Greedy search. implemented A*