对于空间两个点云，利用经典的icp算法进行匹配-ICP fit points in data to the points in model. Fit with respect to minimize the sum of square errors with the closest model points and data points.