Astar with manhattan heuristic