Own heuristic now works. Gives better result than Manhattan