Added astar plan test