added astar test and debugged astar