Manhattan heuristic working (I think)