manhattan

manhattan.cpp

int					Core::_manhattan(Node const &node, Node const &goal) {

	int				sum;
	size_t			gridSize;

	sum = 0;
	gridSize = node.getGrid().getSize();
	for (size_t i = 0; i < gridSize; ++i) {
		for (size_t j = 0; j < gridSize; ++j) {

			int tmpNbr = node.getGrid()[i][j];
			if (tmpNbr != 0) {

				Grid::Pos posB = goal.getGrid().getNumberPos(tmpNbr);
				int tmp1 = i - posB.x;
				int tmp2 = j - posB.y;
				sum += std::abs(tmp1) + std::abs(tmp2);
			}
		}
	}
	return sum;
}