ICP算法的C++源代码。迭代最近点法(Iterative Closest Points Algorithm)