Fixed Astar heuristic, now using manhatten