一种散乱点云图像配准方法
【技术领域】
[0001] 本发明涉及图像处理技术领域，尤其是一种散乱点云图像配准方法。
【背景技术】
[0002] 三维点云拼接技术一直是逆向工程、计算机视觉、模式识别、曲面质量检测及摄影 测量学等领域的研究的热点和难点。三维点云图相配准技术在不同场合也被称之为重定 位、拼接或拼合技术，其实质是把不同的坐标系下测得的数据点云进行坐标变换，问题的关 键是坐标变化参数R(旋转矩阵)和T(平移矢量)的求取。
[0003] 在三维点云图相配准中，最近迭代（ICP)算法是应用最为广泛的配准算法，一般适 用于精度较高的扫描任务以及存在明确对应关系的点集之间的配准，但它对点云之间的相 对初始位置要求较高，如果初始位置相差太大，ICP的收敛方向将不能确定;此外，ICP的改 进算法大多依赖从点云数据中提取的特征点或轮廓曲线等人为引入特征标签，普遍存在鲁 棒性不够稳定、速度较慢等问题，其中基于曲面模型的改进方法在曲面逼近时需要进行点 云分割与模型辨识，不能适应点云的任意拓扑外形。因此，寻找一个高效的优化ICP算法对 三维点云图像配准问题十分必要。
【发明内容】
[0004] 为了解决上述现有技术中的不足之处，本发明提出一种散乱点云图像配准方法， 用PS0算法粗配准是针对整体数据而言的迭代优化算法，不依赖于点云数据的几何特征，数 据的噪声对整体影响较小，满足迭代结束条件后，找到最优平移和旋转参数，为ICP精确算 法找到最优的初始位置。
[0005] -种散乱点云图像配准方法，其特征在于，包括
[0006] 步骤1、获取图形中点云数据的位置和法向量；
[0007] 步骤2、通过基于曲面变化度的局部离群系数过滤点云数据；
[0008] 步骤3、初始化粒子的位置和速度，并将旋转参数R=(rx ry rz)和平移参数T=(tx ty tz)分别转换为R3X3，TlX3矩阵；
[0009] 步骤4、构造适应度函数，求出适应度函数值；
[0010] 步骤5、根据适应度函数值，更新粒子的速度和位置，求得最优粒子，计算出R，T的 向量；
[0011] 步骤6、将最优粒子的位置作为ICP配准初值的参考点集，在目标点集中寻找距离 参考点集的距离最近的点集作为新的目标点集，得到旋转矩阵R和平移矩阵T，使得参考点 集到新的目标点集的最短距离的目标函数值小于阈值τ。
[0012]所述曲面变化度为图形中获取的点云集合中的其中一点极其领域点构成的协方 差矩阵的最小特征值与所有特征值之和的比值，其中协方差矩阵
[0015] 其中罗为p邻域的中心，则曲面 其中k为所用的邻近点 ，. 个数，分别表示数据沿对应的特征向量的方向的变化程度，〇k的取值范围为[0，1/ 3]〇
[0016] 所述基于曲面变化度的局部离群系数过滤点云数据的具体过程为：
[0017] 步骤201、对于任意散乱点云S，利用基于距离查询的区域增长方法，设定区域增长 半径:Γ，区域增长的结果是一系列的点云子集Si，S2 . . . Sn，且Si U S2 U . . . U Sn=S，如果某子 集点数过少，则该子集为孤立的离群点集合;如果某子集的包围盒体积过小，则该子集是聚 集到一起的离群点；
[0018] 步骤202、计算曲面变化度〇k，将曲面变化度大的点识别为潜在离群点；
[0019] 步骤203、对潜在离群点中的点计算其SVL0F值，将SVL0F值大于设定容限的点作为 离群点，从点中滤除，SVL0F值的计算公式为
[0021 ] 其中为欠k领域中的〇k，of为饱和k领域中的〇k。
[0022] 所述适应度函数为
[0023] | R · Qo+T-Qi | | +1 | R · Noma 11-Norma 12 | | =f itness
[0024] 其中，P和Q在两个不同视角下采集的点云集，保持P的位置不变让Q不断靠近P;令 Qo = Q,对Qo进行空间变化得到Qi;其中Normall、Normal2分别为Q〇、Qi的法向量，fitness为 适应度函数值，通过迭代，得到最优粒子，求得的R，T作为ICP迭代配准的初始位置。
[0025] 所述更新粒子的速度V和位置X的公式为
[0027]其中C1，C2为非负的学习参数，ri，r2是介于(0，1)服从均匀分布的两个独立的随机 数，用来保持群体的多样性；是第i个粒子搜索到的局部最好的位置;gbe3St是整个粒子 群搜索到的最好位置。
[0028]步骤6的具体过程为：
[0029]步骤601、利用PS0全局搜索最优的粗略配准找到初始位置的对应点集P和Q，个数 均为η;
[0030]步骤602、计算目标点集Ρ和参考点集Q的重心：
[0032]步骤603、由点集P和Q构造协方差矩阵：
[0034]步骤604、由步骤603中的协方差矩阵构造4 X 4堆成矩阵：
[0036] 其中：13 是 3X3 单位矩阵，tr( 2p,q)是矩阵（2p,q)的迹，Δ =[A23 A31 A12]t，
[0037] 步骤605、计算步骤603中协方差矩阵的特征值和特征向量，其最大特征值对应的 特征向量即为最佳旋转向量；
[0038] qR=[qo qi q2 q3]T;
[0039] 步骤606、计算最佳平移向量：
[0040] qT=yq-R(qR)yP
[0042] 步骤607、得到完全坐标变换向量q= [qR I qT]T= [qoqiq2q3q4q5q6]T，求得最小均方差 dms= f (q)；
[0043] 步骤608、均方差大于阈值τ则返回步骤3,重新迭代，小于阈值τ则迭代结束。
[0044] τ 的值为 0.001。
[0045]本发明提供的基于一种粒子群和最近迭代点相结合的散乱点云匹配算法，利用曲 面变化度的局部离群系数剔除噪音点，同时对PS0粒子群算法的粗略配准中适应度函数进 行了改进，在点云配准中容易选取到噪音点；利用曲面变化度的局部离群系数将离群点剔 除，同时控制法向量平行对点云数据进行约束，提高了散乱点云的配准精度。因此，本发明 通过整体寻优，为ICP找到最佳的初始位置，避免了 ICP陷入局部最优，有效的提高了 ICP算 法的准确性。
【附图说明】
[0046] 图1为本发明散乱点云图像配准方法流程图。
【具体实施方式】
[0047] 为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对 本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并 不用于限定本发明。
[0048]如图1所示，基于粒子群和最近迭代点相结合的散乱点云匹配算法包括如下步骤： [0049] A.获取图像中点云数据的位置和法向量。
[0050] B.通过基于曲面变化度的局部离群系数过滤点云数据，参数包括：区域增长半径 为0.25,点数小于100、体积小于2,将符合以上参数的区域作为离群点滤除，对于近离群点， SVL0F设定阈值为5。
[0051 ] 在此引入欠k领域和饱和k领域Mf的概念：
[0052]给定点集合S及其中一点p，定义该点的欠k领域为点集S中除k点外距离p点最 近的k个点的集合;给定该点的饱和k领域为包含p点的k+Ι个邻近点的集合，即：
[0055]同时引入曲面变化度〇k，曲面变化度反映了曲面离开切平面的程度。定义曲面变 化度〇k为一点极其领域点构成的协方差矩阵C3X3的最小特征值λ〇与所有特征值之和的比 值。
[0056]协方差矩阵：
[0061]其中，及为ρ邻域的中心，k为计算变化度所用的邻近点个数，λοΑΑ分别表示数 据在3个主方向的变化程度，由于协方差矩阵为对称矩阵，其特征值均为正值，故〇k的取值 范围为[0，1/3]。
[0062]曲面变化度识别出潜在离群点，因为如若一点是离群点，则该点处一定具有大的 曲面变化度，但是曲面上棱线、角点等特征部分的点同样具有较大的曲面变化度。为了区分 离群点与特征点，SVL0F定义为：
[0064]将离群点分为两类，一类为远离群点云主体的离群点，另一类为靠近点云主体的 离群点。采用基于三维区域增长的方法对远离群点进行辨识，而利用SVL0F对近离群点进行 鲁棒识别，具体包括以下步骤：
[0065]步骤11:对于任意散乱点云S，利用基于距离查询的区域增长方法，设定区域增长 半径r，区域增长的结果是一系