have astar search working
fixed manhattanDistance