一种适用于球形靶标拟合的自适应栅格搜索方法与流程

1.本发明属于工程测量及三维激光扫描领域，具体涉及一种适用于地面激光扫描的球形靶标拟合的自适应栅格搜索方法。


背景技术：

2.地面三维激光扫描技术是近年来兴起的一种新型的测量技术，通过高速激光扫描，快速获取目标表面的高分辨率点云数据，将传统的单点测量带入到面测量时代。它具有主动式、非接触、高分辨率、高精度、快速灵活的数据采集等特点，已经在工程测量、文物保护、灾害监测、逆向三维重建等工作中得到了广泛的应用。球形靶标具有典型的空间旋转对称性与标准的参数化形式，在地面三维激光扫描的各类研究中发挥着重要的作用，如地面激光扫描仪校准与检核、扫描精度评估、点云的配准与坐标转换等。球形靶标的中心在位于球体内部，无法通过直接的测量手段获取，故通常采用拟合的方法获取其中心。
3.基于三维激光扫描获取的球形靶标的点云拟合其中心坐标，本身是一个非线性问题，目前通常是借助各类最小二乘方法求解，如经典最小二乘法、整体最小二乘法以及加权整体最小二乘等。从最小二乘的理论角度来看，最小二乘估计假设数据噪声的均值为零，从而产生一个无偏参数估计。如果噪声的方差已知，则可以通过在数据上选择适当的权重得到最小方差参数估计。此外，最小二乘估计隐含地假设整个数据集只能由给定模型的一个参数向量来解释。大量的研究清楚地表明，最小二乘估计很容易违反这些假设。有时，即使数据只包含一个坏的数据，最小二乘估计也可能严重地受到干扰，导致解算结果较差。故这类方法多是基于单纯的测点数据求解，易出现精度受初值影响大、易陷局部最优等问题。同时，球形靶标的点云的测点数量通常在数千个以上，会造成计算矩阵庞大，运行效率低。
4.在扫描工作中，我们采用的球形靶标具有确定的几何尺寸，即针对空间中的任一球形靶标，其点云在空间中的分布是有一定的范围的，将其称为包围盒，这个包围盒包含球形靶标的所有测点数据以及噪声。同时，从球形靶标的几何特性来看，其中心与半径一定在这个包围盒中。这样，可以采用一种搜索策略，找到包围盒中满足特定误差判定规则的最优中心与半径。在这种背景下，我们结合球形靶标的点云与几何特征，提出了一种适用于各类球形靶标拟合的自适应栅格搜索方法。


技术实现要素：

5.本发明的目的在于结合球形靶标的测点信息与几何特征信息，设计一种适用于球形靶标拟合的自适应栅格搜索方法，该方法不仅避免了线性化问题的精度损失，提升了球形靶标中心的解算精度，且通过球形靶标几何特征的约束，提高了解算的效率。
6.为实现上述目的，本发明采取的技术方案是：一种适用于球形靶标拟合的自适应栅格搜索方法，其包括以下步骤：
7.步骤1：利用三维激光扫描系统获取球形靶标点云；
8.步骤2：设置初始参数；
9.步骤3：设定拟合误差的判定准则，获取最优的球形靶标中心与半径；
10.步骤4：确定初始尺度初始尺度由x、y、z、r四个特征量的尺度组成，主要由点云的几何重心与预设的几何半径r
set
共同确定；
11.步骤5：构建初始样本空间u
(1)
；初始样本空间；初始样本空间中的每个样本由四个特征量构成，其中为球形靶标的可能几何中心，为球形靶标的可能几何半径；
12.步骤6：确定初始的最优样本；
13.步骤7：更新尺度
14.步骤8：更新样本空间u(i)；
15.步骤9：寻找最优样本；
16.步骤10：循环执行步骤7、步骤8、步骤9，直到找到满足预定精度的样本，或者达到预定的循环次数n
opt
。
17.进一步地，所述步骤1中，利用地面三维激光扫描系统或者车载三维激光扫描系统采集球形靶标的点云p＝{(xi,yi,zi)|i＝1,2,
…
,n}，球形靶标点云由球形靶标表面的测点数据组成，每个测点由x、y、z三个坐标分量组成。
18.进一步地，所述步骤2中，初始参数主要由球形靶标的预设几何半径r
set
、栅格采样数n
sub
、迭代优化次数n
opt
、拟合误差阈值e
min
四部分组成；其中，球形靶标的预设几何半径r
set
为欲拟合的球形靶标半径的预估值；栅格采样数n
sub
为在空间栅格构建时，(x,y,z,r)各维度的采样个数；迭代优化次数n
opt
为预定的迭代优化的最大执行次数，该值用于限定拟合过程的迭代次数，防止出现无限循环；拟合误差阈值e
min
为判定结束搜索条件的球形靶标点云的总体误差。
19.进一步地，所述步骤3中，为获取最优的球形靶标中心与半径，设定最优中心与半径的判定准则；这里采用算术误差测度，以拟合误差e
fit
评价；假设球形靶标的拟合中心为(a,b,c)，拟合半径为r，那么拟合误差e
fit
的可由式(1)确定：
[0020][0021]
式中，(xi,yi,zi)为球形靶标点云的测点坐标，n为球形靶标点云所含的测点个数。
[0022]
进一步地，所述步骤4中，几何重心由式(2)计算可得，初始尺度由式(3)计算可得：
[0023][0024]
式中，(xi,yi,zi)为点云p的测点坐标，n为点云p的测点个数；
[0025][0026]
进一步地，所述步骤5中，初始样本空间u
(1)
中的样本由初始尺度与预设的栅格采样数n
sub
共同确定，为x
(1)
、y
(1)
、z
(1)
、r
(1)
四个特征量的所有取值组合，由式(4)确定各特征量的可能取值：
[0027][0028]
式中，取值为0，因为球形靶标的几何半径永远大于0。
[0029]
进一步地，所述步骤6中，利用步骤3的判定准则，对初始样本空间u
(1)
中的每个样本逐一进行拟合误差计算，选取拟合误差最小的样本作为初始的最优解；在计算拟合误差的过程中，应检测每个样本的拟合误差是否达到了预设的拟合误差阈值e
min
，如果达到，就可以将当前样本作为最终的拟合结果，否则，继续检测。
[0030]
进一步地，所述步骤7中，栅格搜索过程中，获取最优值的概率与栅格空间的精度有关，栅格空间越精细，则寻找到最优值的概率越高；假定在尺度下，未找到满足预定精度的样本点，则需要进一步优化搜索尺度，以提高样本的精细度；尺度更新利用式(5)计算：
[0031][0032]
进一步地，所述步骤8中，基于前次栅格搜索中得到的最优中心(x
(i-1)
,y
(i-1)
,z
(i-1)
)与半径r
(i-1)
，以及更新后的尺度生成新的样本空间u(i)；样本空间为x(i)、y(i)、z(i)、r(i)四个特征量的所有取值组合，由式(6)可以各特征量的可能取值：
[0033][0034]
进一步地，所述步骤9中，利用步骤3的判定准则，对更新后的样本空间u(i)中的每个样本逐一进行误差检测，选取拟合误差最小的样本作为最优解；在计算拟合误差的过程中，检测每个样本的拟合误差是否达到了预设的拟合误差阈值e
min
，如果达到，就可以将当前样本作为最终的拟合结果，否则，继续检测。
[0035]
综上，本方法的球形靶标拟合即从分布未知及包含异常值的点云中提取球形靶标的球心坐标与半径，这实际上就是一个最优参数估计的问题。在此最优参数估计问题中，将球形靶标的中心坐标(x,y,z)与半径r视为待求解参数，将靶标点云作为观测值，利用球形靶标点云拟合其中心坐标与半径的过程，可以看作是一个寻找满足特定判定规则的最优参数的过程。以球形靶标点云的几何重心为中心，以2倍以上的半径长度为约束，构建一个初始包围盒，而根据球形靶标的几何特征，其中心与半径必然在此包围盒内。基于此特性，则可以从概率的角度解决球形靶标拟合问题。
[0036]
本发明的有益效果是：本发明结合球形靶标的点云与几何特征信息，利用自适应栅格搜索方法实现了球形靶标中心与半径的准确拟合，避免了线性化过程中的精度损失问题。本发明不仅可以实现球形靶标点云中心与半径的高精度解算，且执行效率较高。
[0037]
同时，发明不仅适用于地面或车载三维激光扫描球形靶标的中心解算，且可以应用于其他球形对象的中心坐标提取。
附图说明
[0038]
图1是本发明的流程图；
[0039]
图2是球形靶标的模拟点云图；
[0040]
图3是构建的初始样本空间图；
[0041]
图4是更新后的样本空间图。
具体实施方式
[0042]
下面结合附图和具体实施例对本发明进行详细说明。
[0043]
如图1，本发明提供了一种适用于各类球形靶标拟合的自适应栅格搜索算法，具体实施步骤如下：
[0044]
步骤1：利用三维激光扫描系统获取球形靶标点云。利用地面三维激光扫描系统或者车载三维激光扫描系统采集球形靶标的点云p＝{(xi,yi,zi)|i＝1,2,
…
,n}，球形靶标点云由球形靶标表面的测点数据组成，每个测点由x、y、z三个坐标分量组成。
[0045]
步骤2：设置初始参数。初始参数主要由球形靶标的预设几何半径r
set
、栅格采样数n
sub
、迭代优化次数n
opt
、拟合误差阈值e
min
等四部分组成。球形靶标的预设几何半径r
set
是指欲拟合的球形靶标半径的预估值，该值通常很容易确定。在三维激光扫描作业中，所采用的
球形靶标的几何半径往往在技术说明书中有明确的说明。如果无法确定欲拟合的球形靶标的几何半径，可以设定一个相对略大的经验估计值。栅格采样数n
sub
是指在空间栅格构建时，(x,y,z,r)各维度的采样个数。迭代优化次数n
opt
是指预定的迭代优化的最大执行次数，该值用于限定拟合过程的迭代次数，防止出现无限循环。拟合误差阈值e
min
是指判定结束搜索条件的球形靶标点云的总体误差，该值可由步骤3的误差判定准则计算得到，这里设定阈值，可以实现达到预定的拟合误差后，直接结束后续搜索，以提高算法的效率。
[0046]
步骤3：设定拟合误差的判定准则。为了获取最优的球形靶标中心与半径，必须设定最优中心与半径的判定准则。这里采用一种算术误差测度，以拟合误差e
fit
评价，它由所有测点的误差和求得。假设球形靶标的拟合中心为(a,b,c)，拟合半径为r，那么拟合误差e
fit
的可由式(1)确定。
[0047][0048]
式中，(xi,yi,zi)为球形靶标点云的测点坐标，n为球形靶标点云所含的测点个数。
[0049]
步骤4：确定初始尺度初始尺度由x、y、z、r四个特征量的尺度组成，主要由点云的几何重心与预设的几何半径r
set
共同确定。几何重心由式(2)计算可得，初始尺度由式(3)计算可得。
[0050][0051]
式中，(xi,yi,zi)为点云p的测点坐标，n为点云p的测点个数。
[0052][0053]
步骤5：构建初始样本空间u
(1)
。初始样本空间。初始样本空间中的每个样本由四个特征量构成，其中为球形靶标的可能几何中心，为球形靶标的可能几何半径。初始样本空间u
(1)
中的样本主要由初始尺度与预设的栅格采样数n
sub
共同确定，为x
(1)
、y
(1)
、z
(1)
、r
(1)
四个特征量的所有取值组合，由式(4)确定各特征量的可能取值。
[0054][0055]
式中，取值为0，因为球形靶标的几何半径永远大于0。
[0056]
步骤6：确定初始的最优样本。利用步骤3的判定准则，对初始样本空间u
(1)
中的每个样本逐一进行拟合误差计算，选取拟合误差最小的样本作为初始的最优解。在计算拟合误差的过程中，应检测每个样本的拟合误差是否达到了预设的拟合误差阈值e
min
，如果达到了，就可以将当前样本作为最终的拟合结果，否则，继续检测。
[0057]
步骤7：更新尺度由概率统计理论可知，在栅格搜索过程中，获取最优值的概率与栅格空间的精度有关，栅格空间越精细，则寻找到最优值的概率越高。假定在尺度下，未找到满足预定精度的样本点，则需要进一步优化搜索尺度，以提高样本的精细度。尺度更新利用式(5)计算。
[0058][0059]
步骤8：更新样本空间u(i)。基于前次栅格搜索中得到的最优中心(x
(i-1)
,y
(i-1)
,z
(i-1)
)与半径r
(i-1)
，以及更新后的尺度生成新的样本空间u(i)。样本空间为x(i)、y(i)、z(i)、r(i)四个特征量的所有取值组合，由式(6)可以各特征量的可能取值。
[0060][0061]
步骤9：寻找最优样本。利用步骤3的判定准则，对更新后的样本空间u(i)中的每个样本逐一进行误差检测，选取拟合误差最小的样本作为最优解。在计算拟合误差的过程中，检测每个样本的拟合误差是否达到了预设的拟合误差阈值e
min
，如果达到了，就可以将当前样本作为最终的拟合结果，否则，继续检测。
[0062]
步骤10：循环执行步骤7、步骤8、步骤9，直到找到满足预定精度的样本，或者达到预定的循环次数n
opt
。此时，将最优的样本作为最终的拟合结果，并结束拟合。一般情况下，经过十几次迭代优化，基本就可以确定最优解。
[0063]
下面结合具体数据对上述实施例的方案进行进一步说明：
[0064]
顾及球形靶标的几何中心位于球体内部，无法通过直接的测量手段获取，造成拟合精度不易评估。这里采用几何中心与半径已知的模拟数据说明说明本发明的实施方法及拟合精度。
[0065]
(1)以真实中心坐标(1000,1000,100)、半径为0.0725m，模拟球形靶标的3260个测点数据，如图2所示，其中黑色点为模拟的点云数据。
[0066]
(2)按步骤2方法，设置初始参数。预设几何半径r
set
为0.0725m、栅格采样数n
sub
为10、迭代优化次数n
opt
为30、拟合误差阈值e
min
为0.001。
[0067]
(3)按步骤4确定初始尺度计算结果为(0.2900,0.2900,0.2900,0.1450)。
[0068]
(5)按步骤5构建初始样本空间u
(1)
，如图3所示，其中“*”表示样本点的位置。此时，样本空间中共包含10000个样本，在空间中呈均匀栅格分布。
[0069]
(4)利用步骤3的判定准则，按步骤6确定初始的最优样本。此时，获取的最优样本是(1000.0159,1000.0161,100.0342,0.0805)，其拟合误差5.0608大于预定的拟合误差0.001，不满足预定精度，则需要更新尺度与样本空间。
[0070]
(5)按步骤7更新尺度。更新后的尺度为(0.0725,0.0725,0.0725,0.0363)。
[0071]
(6)按步骤8更新样本空间u
(2)
，如图4所示，其中“*”表示样本点的位置。此时，样本空间中共包含10000个样本，在空间中呈均匀栅格分布。
[0072]
(7)按步骤9寻找更新尺度与样本空间后的最优样本。此时，获取的最优样本是(1000.0078,1000.0080,99.9954,0.0765)，其拟合误差2.0472大于预定的拟合误差阈值0.001，不满足预定精度，则需要继续更新尺度与样本空间。
[0073]
(8)按步骤10，循环执行步骤7、步骤8、步骤9，经过17次迭代优化后，此时获取的最优样本是(1000.0000,1000.0000,100.0000,0.0725)，其拟合误差0.0002小于预定的拟合误差阈值0.001，达到了预定的精度，迭代过程结束。同时，统计其执行耗时约为1.5396秒。
[0074]
从实验结果来看，本发明所设计的方法可以准确地拟合球形靶标中心点的坐标与半径，且执行效率较高。
[0075]
以上显示和描述了本发明的基本原理、主要特征和优点。本领域的普通技术人员应该了解，上述实施例不以任何形式限制本发明的保护范围，凡采用等同替换等方式所获得的技术方案，均落于本发明的保护范围内。
[0076]
本发明未涉及部分均与现有技术相同或可采用现有技术加以实现。