Astar Step1 done! Step2 in progress