【技术实现步骤摘要】
一种基于抗差约束最小二乘算法的点云精确配准方法
本专利技术属于计算机视觉领域,具体涉及一种基于抗差约束最小二乘(RobustConstrainedLeastSquares,简称RCLS)算法的点云精确配准方法。
技术介绍
3D点云配准是计算机视觉领域的关键研究问题之一,在逆向工程、SLAM、图像处理和模式识别等方面具有重要应用。点云配准的目的是求解出同一坐标下不同姿态点云的变换矩阵,利用该矩阵实现多视扫描点云的精确配准,最终获取完整的3D数字模型。针对3D点云配准,国内外学者进行了大量的研究,但大部分研究方法往往集中于前期的对应点对搜索,通过提取点云的相关特征如法向量,曲率等以提高对应点对搜索效率,然后通过SVD法或四元数法等解析解的方法求旋转矩阵R和平移向量T,但是这些方法没有考虑点云数据中含有的粗差以及三角函数计算的繁琐,在一定程度上限制了点云配准的精度。
技术实现思路
专利技术目的:为解决上述问题,本专利技术提供了一种基于抗差约束最小二乘算法的点云精确配准方法,能进行任意角度的点云配准,缩短 ...
【技术保护点】
1.一种基于抗差约束最小二乘算法的点云精确配准方法,其特征在于,包括以下步骤:/n(1)获取经过去噪滤波处理的待配准点云和目标点云;/n(2)通过PCA算法对待配准点云和目标点云进行粗配准;/n(3)利用kd-tree搜索待配准点云在目标点云中的对应点,设置搜索距离阈值η,删除错误的点对;/n(4)根据点云的法向量特征,提取特征度较大的点;/n(5)将得到的对应点对利用抗差约束最小二乘算法,将待配准点云通过旋转和平移配准到目标点云上,直至两点云的满足距离阈值δ。/n
【技术特征摘要】
1.一种基于抗差约束最小二乘算法的点云精确配准方法,其特征在于,包括以下步骤:
(1)获取经过去噪滤波处理的待配准点云和目标点云;
(2)通过PCA算法对待配准点云和目标点云进行粗配准;
(3)利用kd-tree搜索待配准点云在目标点云中的对应点,设置搜索距离阈值η,删除错误的点对;
(4)根据点云的法向量特征,提取特征度较大的点;
(5)将得到的对应点对利用抗差约束最小二乘算法,将待配准点云通过旋转和平移配准到目标点云上,直至两点云的满足距离阈值δ。
2.根据权利要求1所述的基于抗差约束最小二乘算法的点云精确配准方法,其特征在于,所述步骤(1)实现过程如下:
采用SOA的离群噪声去除算法对两点云进行去噪滤波处理,设待处理的点云为P={pi∈R3∣i=1,2,3,…,n},n为待处理点云中的采样点个数,对其中的任意采样点pi,建立pi的k邻域,计算采样点pi到它的k邻域点的平均距离,之后判断平均距离,如果距离在设定范围内,则判定为主体点云,否则,判定为噪声点,然后移除噪声点。
3.根据权利要求1所述的基于抗差约束最小二乘算法的点云精确配准方法,其特征在于,所述步骤(2)实现过程如下:
(21)计算待配准点云P和目标点云Q的质心点坐标:
式中,N和M代表待配准点云P和目标点云Q的点云数量,UP和UQ代表P,Q的质心点坐标;
(22)计算两组点云的协方差:
covP=(P-UP)(P-UP)T
covQ=(Q-UQ)(Q-UQ)T
式中,UP和UQ代表P,Q的质心点坐标,cov表示协方差,T表示转置;
(23)通过协方差矩阵,分别求两组点云各自的特征向量,按特征值将特征向量从大到小排列,求出粗配准的旋转矩阵R和平移矩阵T,将两组点云形成的坐标轴统一到相同的坐标系下,完成粗配准。
4.根据权利要求1所述的基于抗差约...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。