写了几个点云配准的算法,主要包括PFH、FPFH、icp、NDT、3Dsc几种粗配准算法,并计算出误差。