Add astar and manhatten