Implemented new semi-euclidean heuristic.