一种基于自适应特征点提取的点云粗配准方法与流程

一种基于自适应特征点提取的点云粗配准方法
1.技术邻域
2.本发明属于点云匹配技术邻域，本发明涉及一种点云特征提取的方法，特别涉及一种基于自适应特征点提取的点云粗配准方法。


背景技术：

3.由于激光技术的日趋成熟和应用邻域的不断扩展，各种各样的激光系统在文物修复、军事航天、工业制造、医学影像建模、目标识别等邻域中起着至关重要的作用。近年来，随着三维扫描技术和三维成像技术的快速发展，作为关键技术之一的三维点云配准技术，得到了广泛的研究和应用。点云配准的目的在于找到一个三维刚体变换，使得同一物体在不同视角下的点云变换至相同坐标系下，快速准确地匹配和拼接。
4.目前，点云配准技术多采用粗匹配和精配准结合的思想，粗配准为精配准提供良好的初始条件，精配准对粗匹配的结果进行优化，二者缺一不可。在精配准中，应用最为广泛的是icp(iterative closest point,迭代最近点)算法,该算法对初始位置敏感。针对这个问题，主要对粗匹配进行优化。
5.基于粗匹配的配准算法，主要是通过对点云特征的匹配。对于点云特征的提取，流行的算法有尺度不变特征转换(sift)、内在形状签名(iss)、加速稳健特征(surf)等。sift算法，对不同模型需要根据经验设置不同的参数，过程繁琐；iss算法，可快速获取点云的特征，但该算法所提取特征点数量少使得最终的匹配效率低；surf算法，过于依赖局部区域像素的梯度方向，易造成后续匹配失败。特征的匹配取决于对特征点的全面描述，典型的特征描述有旋转图像(spin image)、点特征直方图(pfh)、旋转投影统计特征(rops)、方向特征直方图(shot)。spin image描述子对非均匀采样敏感、pfh描述子的鉴别能力很强但是极为耗、rops描述子对点分布不均的数据描述性差且计算较为耗时、shot描述子对点云的分辨率敏感。上述算法存在过于依赖算法参数设置、无法准确提取点云特征点、不能全面描述特征信息等问题，这都将导致点云配准误差增大，效率降低。
6.针对上述点云配准算法中存在参数设置复杂、配准精度低和速度慢等问题，找到一种合适的算法尤为重要。


技术实现要素：

7.本发明的目的是提供一种基于自适应特征点提取的点云粗配准方法，可以根据局部表面变化因子大小，自动提取点云的特征点，从而有效地提取点云特征，为点云精配准提供一个良好的初始位置。
8.本发明所采用的技术方案是，一种基于自适应特征点提取的点云粗配准方法，具体按照以下步骤实施：
9.步骤1：设置邻域α的球半径r1，求任意点p
i
以r1为半径的邻域α的加权协方差c
i
和表面变化因子σ(p
i
)；
10.步骤2：计算任意点p
i
的邻域α内的平均表面变化因子ε
i
，将平均变化因子ε
i
与σ
(p
i
)进行对比，获取采样特征点集p
temp
；
11.步骤3：设置邻域β的球半径r2，保留每个采样特征点以r2为半径邻域β内的重心，即为最终特征点，每个采样特征点取自步骤2所得的采样特征点集 p
temp
；
12.步骤4：根据步骤3所获取最终特征点，结合快速点特征直方图(fpfh) 描述子，对最终特征点进行综合描述，获取最终特征点的点云的特征信息；
13.步骤5：利用随机抽样一致性(ransac)算法，简化特征提取的同时剔除误匹配点对，进行粗配准。
14.本发明的特点还在于：
15.步骤1具体按照以下步骤实施：
16.步骤1.1、源点云p中任意点p
i
，任意点p
i
的局部的邻域α点为p
1k
,p
2k
,...p
ik
，则点p
i
邻域α的协方差矩阵为
[0017][0018]
式(1)中，c是一个半正定矩阵；权重函数是一个递减的函数，r为p
i
邻域的球半径，k是局部邻域α内点的个数，p
ij
是局部邻域α内的点；
[0019]
步骤1.2、对c进行特征值分解可得特征值λ1,λ2,λ3，设λ1<λ2<λ3，p
i
邻域α内表面的变化因子σ(p
i
)的大小反映了局部曲面的弯曲程度或者光滑程度，其值越小表明局部表面越平坦，p
i
邻域α内表面的变化因子σ(p
i
)的形式如下：
[0020][0021]
式(2)中，λ1,λ2和λ3分别代表三维椭球体三个主半轴的长度。如图1、2 所示各种场景中一个点的邻域中的表面变化图1是较为平坦的表面，图2是有起伏的表面。
[0022]
步骤2具体按照以下步骤实施：
[0023]
步骤2.1、p
i
邻域α局部平均变化情况如下：
[0024][0025]
步骤2.2、判断ε
i
和σ(p
i
)的大小，当ε
i
>σ(p
i
)时，保留p
i
为采样特征点，从而获取点云的采样特征点集p
temp
。
[0026]
步骤3具体按照以下步骤实施：
[0027]
步骤3.1、设置采样特征点集p
temp
中点的邻域β的球半径r2，保留每个采样特征点以r2为半径邻域β内的重心；
[0028]
步骤3.2、获得源点云p的特征点集p'，同理获取目标点云q的特征点集 q'。
[0029]
步骤4具体按照以下步骤实施：
[0030]
步骤4.1、定义特征点集p'中任意特征点p
q
的局部邻域γ的darboux坐标系(u，v，w)；
[0031][0032]
式(4)中，p
t
和p
s
为特征点p
q
的邻域γ内点对；
[0033]
步骤4.2、计算邻域γ内点每一对特征点的关系；
[0034][0035]
式(5)式中，n
t
和n
s
分别为p
t
和p
s
的法线，d为p
t
和p
s
的欧氏距离；
[0036]
步骤4.3、对于每个所求的特征点p
q
，计算特征点p
q
与它的邻域γ内点之间的一组(α，φ，θ)，得到简化的点特征直方图spfh，重新确定每个所求特征点的k个邻域点，计算fpfh：
[0037][0038]
式(6)中，w
k
为权重，p
qi
是特征点p
q
邻域内的邻近点。
[0039]
步骤5具体按照以下步骤实施：
[0040]
步骤5.1、选取p'中的n个点，同时确定n个点的空间距离大于设定的阈值 d
min
；
[0041]
步骤5.2、对于每个采样点，在q'中找到具有相似fpfh特征的一个或者多个相似点，从相似点中随机选取至少三个相似点作为对应点；
[0042]
步骤5.3、计算对应点之间刚体变换矩阵,然后通过求解对应点变换后的距离误差函数来判断当前配准变换的性能，即
[0043][0044]
式(7)中，m
i
是预先设定的值，|l
i
|为第i组对应点变换之后的距离差；
[0045]
步骤5.4：重复上述的步骤，直至距离误差函数达到阈值ε，其对应的变换矩阵为粗匹配的变换矩阵。
[0046]
本发明的有益效果是：
[0047]
1、特征点的提取。特征点的提取中，在协方差函数中引入距离权重函数，消除了邻域内近邻点距离对采样点的影响。同时根据局部邻域表面变化因子与平均变化因子的大小自动进行特征点的提取，在有效提取特征点的同时，减少了参数设置的复杂过程。
[0048]
2、特征点的描述。用fpfh描述子对特征点进行描述，综合描述了特征点信息的同时简化了描述的复杂过程。
[0049]
3、特征匹配。利用随机抽样一致性(ransac)算法进行粗配准，简化特征提取的同时剔除误匹配点对，是的配准精度更高。
附图说明
[0050]
图1是本发明的各种场景中一个点的邻域中的平坦的表面变化图；
[0051]
图2是本发明的各种场景中一个点的邻域中的有起伏的表面变化图。
具体实施方式
[0052]
下面结合附图和具体实施方式对本发明进行详细说明。
[0053]
一种基于自适应特征点提取的点云粗配准方法，其特征在于，具体按照以下步骤实施：
[0054]
步骤1：设置邻域α的球半径r1，求任意点p
i
以r1为半径的邻域α的加权协方差c
i
和表面变化因子σ(p
i
)；
[0055]
步骤2：计算任意点p
i
的邻域α内的平均表面变化因子ε
i
，将平均变化因子ε
i
与σ(p
i
)进行对比，获取采样特征点集p
temp
；
[0056]
步骤3：设置邻域β的球半径r2，保留每个采样特征点以r2为半径邻域β内的重心，即为最终特征点，每个采样特征点取自步骤2所得的采样特征点集 p
temp
；
[0057]
步骤4：根据步骤3所获取最终特征点，结合快速点特征直方图(fpfh) 描述子，对最终特征点进行综合描述，获取最终特征点的点云的特征信息；
[0058]
步骤5：利用随机抽样一致性(ransac)算法，简化特征提取的同时剔除误匹配点对，进行粗配准。
[0059]
步骤1具体按照以下步骤实施：
[0060]
步骤1.1、源点云p中任意点p
i
，任意点p
i
的局部的邻域α点为p
1k
,p
2k
,...p
ik
，则点p
i
邻域α的协方差矩阵为
[0061][0062]
式(1)中，c是一个半正定矩阵；权重函数是一个递减的函数，r为p
i
邻域的球半径，k是局部邻域α内点的个数，p
ij
是局部邻域α内的点；
[0063]
步骤1.2、对c进行特征值分解可得特征值λ1,λ2,λ3，设λ1<λ2<λ3，p
i
邻域α内表面的变化因子σ(p
i
)的大小反映了局部曲面的弯曲程度或者光滑程度，其值越小表明局部表面越平坦，p
i
邻域α内表面的变化因子σ(p
i
)的形式如下：
[0064][0065]
式(2)中，λ1,λ2和λ3分别代表三维椭球体三个主半轴的长度。如图1、2 所示各种场景中一个点的邻域中的表面变化图1是较为平坦的表面，图2是有起伏的表面。
[0066]
步骤2具体按照以下步骤实施：
[0067]
步骤2.1、p
i
邻域α局部平均变化情况如下：
[0068]
[0069]
步骤2.2、判断ε
i
和σ(p
i
)的大小，当ε
i
>σ(p
i
)时，保留p
i
为采样特征点，从而获取点云的采样特征点集p
temp
。
[0070]
步骤3具体按照以下步骤实施：
[0071]
步骤3.1、设置采样特征点集p
temp
中点的邻域β的球半径r2，保留每个采样特征点以r2为半径邻域β内的重心；
[0072]
步骤3.2、获得源点云p的特征点集p'，同理获取目标点云q的特征点集 q'。
[0073]
步骤4具体按照以下步骤实施：
[0074]
步骤4.1、定义特征点集p'中任意特征点p
q
的局部邻域γ的darboux坐标系(u，v，w)；
[0075][0076]
式(4)中，p
t
和p
s
为特征点p
q
的邻域γ内点对；
[0077]
步骤4.2、计算邻域γ内点每一对特征点的关系；
[0078][0079]
式(5)式中，n
t
和n
s
分别为p
t
和p
s
的法线，d为p
t
和p
s
的欧氏距离；
[0080]
步骤4.3、对于每个所求的特征点p
q
，计算特征点p
q
与它的邻域γ内点之间的一组(α，φ，θ)，得到简化的点特征直方图spfh，重新确定每个所求特征点的k个领域点，计算fpfh：
[0081][0082]
式(6)中，w
k
为权重，p
qi
是特征点p
q
邻域内的邻近点。
[0083]
步骤5具体按照以下步骤实施：
[0084]
步骤5.1、选取p'中的n个点，同时确定n个点的空间距离大于设定的阈值 d
min
；
[0085]
步骤5.2、对于每个采样点，在q'中找到具有相似fpfh特征的一个或者多个相似点，从相似点中随机选取至少三个相似点作为对应点；
[0086]
步骤5.3、计算对应点之间刚体变换矩阵,然后通过求解对应点变换后的距离误差函数来判断当前配准变换的性能，即
[0087][0088]
式(7)中，m
i
是预先设定的值，|l
i
|为第i组对应点变换之后的距离差；
[0089]
步骤5.4：重复上述的步骤，直至距离误差函数达到阈值ε，其对应的变换矩阵为粗匹配的变换矩阵。