CN106382917A - 一种室内环境三维空间信息连续采集方法 - Google Patents

Abstract

本发明涉及一种室内环境三维空间信息连续采集方法，操作步骤为：使用室内移动测量系统获取点云数据，选择相邻时间段线扫点云，进行特征查找和粗匹配，计算相对几何关系，构建整个采集时间段内所有线扫点云的相对位置关系，根据时间和粗匹配的相对位置关系，计算三维激光点云的精确位置相对关系，根据精确位置关系，对整个时间段内粗匹配关系进行修正，对比粗匹配与精匹配的相对关系值小于阈值，以及查看是否所有数据经过配准，如果不满足条件，则重复进行精匹配及修正步骤，否则，方法结束，完成空间三维信息的采集。本方法具有自动化程度高、快速高效的优点。

Description

一种室内环境三维空间信息连续采集方法

技术领域

本发明涉及一种室内环境三维空间信息连续采集方法，属于摄影测量和三维激光技术领域。

背景技术

移动测量系统作为一种新兴的空间信息采集手段，正逐步的广泛应用于各行各业。在室外环境下，移动测量系统使用POS系统进行定位定姿，再结合系统上装备的各类传感器如三维激光扫描仪与高清全景相机，进行空间三维信息的采集获取。然而，在室内环境下，由于GPS信号的缺失及不可靠，基本的定位定姿精度无法保证，后续的信息无法融合，导致无法直接使用室外环境下可用的移动测量系统，进行空间信息的连续精确采集。

发明内容

本发明的目的是为了解决现有技术面临的问题，而提供一种基于SLAM原理的室内环境空间三维信息连续采集方法，获取三维激光扫描仪、相机等传感器在不同时刻采集的精确位置和姿态参数，从而确保系统采集的数据的精度和可靠性。

为实现上述目的，本发明所采用的技术方案是：提出一种室内环境三维空间信息连续采集方法。首先，使用室内移动测量系统在室内环境下进行采集数据，采集数据过程在载体移动前进中进行，通过线扫激光扫描仪用于获取用于粗匹配的点云数据，地面三维激光扫描仪在载体短暂停止时进行三维扫描获取三维点云数据，同时，记录存储采集的时间信息。定义室内移动测量系统中的载体坐标系，以线扫激光扫描仪中心为坐标系原点，载体行驶的方向为Y轴正方向，垂直向上的方向为Z轴正方向，根据右手坐标系确定X轴方向，地面三维激光扫描仪内部定义三维空间直角坐标系为扫描仪中心为其内部坐标系的原点，在其自身水平情况下采集时第一束激光发射的方向为X轴正方向，垂直向上的方向为Z轴，根据右手坐标系确定Y轴方向，地面三维激光扫描仪的外参数可表示载体坐标系转换至三维激光扫描仪坐标系的变换关系，再按如下步骤操作：

步骤1、根据时间信息，选取相邻两个时间段(T_i，T_i+1)，线扫激光扫描仪采集获取的粗匹配点云数据(Pcd_i，Pcd_i+1)，通过特征提取算法进行特征点选取及匹配，估计两个匹配点云数据的相对位移及姿态估计，建立两个粗匹配点云之间的相对位置关系，用旋转矩阵及偏移量(R₀，T₀)表示；

步骤2、重复步骤1，不断进行点云匹配，建立整个采集时间范围内获取点云信息的相对几何关系，从而建立其在任意时刻T_i采集的点云数据在粗始坐标系下的位置及姿态信息(R_i，T_i)；

步骤3、根据记录的时间信息，查找出地面三维激光扫描仪进行三维空间信息采集的时刻，对任意一对地面三维激光扫描获取的三维点云(PCD_t1，PCD_t2)，其对应的时间分别为t₁和t₂，其对应的线扫激光扫描仪的位置和姿态为(R₁，T₁)、(R₂，T₂)。载体系统中，地面三维激光扫描仪及线扫激光扫描仪均固定在一个刚性平台上，其相对位置及姿态关系保持固定不变，即三维点云(PCD_t1，PCD_t2)之间的粗始相对关系，可由(R₁，T₁)及(R₂，T₂)，直接计算推导，为(R_ret，T_ret)；

步骤4、在三维空间点云对(PCD_t1，PCD_t2)中进行特征选取与匹配，通过ICP算法，在给定粗始值(R_ret，T_ret)的情况下，计算出最优参数，从而获取出三维空间点云之间的准确相对参数关系(R_pre，T_pre)，可以将两个点云统一在同一个坐标系下；

步骤5、通过步骤4中计算的精确相对位置关系(R_pre，T_pre)，对步骤2中计算出的粗匹配相对位置关系(R_ret，T_ret)，进行修正，调整整体的粗步相对位置关系，之后再次进行步骤3及步骤4，对其他的三维空间点云进行精确匹配，获取更加准确的相对位置关系，之后再次对粗匹配参数进行改正，再次计算，重复迭代，直至所有点云数据(线扫激光扫描仪及三维激光扫描仪获取)均完成精确匹配且参数变化小于规定阈值δ时，结束计算。

本发明的方法步骤1中所述根据时间信息，选取相邻两个时间段(T_i，T_i+1)，在选取时选取时间间隔应当大于单次整圈线扫时间，一般为整圈线扫时间的整数倍，时间段也不用间隔过大，使得线扫激光扫描仪采集获取的粗匹配点云数据(Pcd_i，Pcd_i+1)，存在同名特征，通过特征提取算法进行特征点选取及匹配，估计两个匹配点云数据的相对位移及姿态估计，建立两个粗匹配点云之间的相对位置关系，用旋转矩阵及偏移量(R₀，T₀)表示，如公式①所示；

$\left(\begin{array}{c}{X}_{i+1}\\ Y_{i+1}\\ Z_{i+1}\end{array}\right)=\left(\begin{array}{c}{X}_i\\ Y_i\\ Z_i\end{array}\right)*\left(R_0\right)+\left(T_0\right)$ …………………………………①

其中，(X_i，Y_i，Z_i)为Pcd_i中提取的特征点，(X_i+1，Y_i+1，Z_i+1)为Pcd_i+1中对应的特征点。

本发明的方法步骤2中所述重复步骤1，不断进行点云匹配，即选取上一步中下一时间(T_i+1，T_i+2)，计算相对几何关系，那么可以得到(T_i，T_i+2)两个时刻点云之间的相对几何关系，则可建立其整个采集时间范围(T₀，T_n)内获取点云信息的粗步相对几何关系，从而建立其在任意时刻T_i采集的点云数据在粗始坐标系下的位置及姿态信息(R_i，T_i)，值得注意是，为了提高后期计算精度，减少传播误差，可以在外业数据采集时通过采用采集闭合路线的方式进行数据采集。

本发明的方法步骤3中所述的根据记录的时间信息，查找出地面三维激光扫描仪进行三维空间信息采集的时刻，在外业采集时，地面三维激光扫描仪进行扫描时，载体会处于静止状态，记录下此时的时间，对任意一对地面三维激光扫描获取的三维点云(PCD_t1，PCD_t2)，其对应的时间分别为t₁和t₂，其对应的线扫激光扫描仪的位置和姿态为(R₁，T₁)、(R₂，T₂)。载体系统中，地面三维激光扫描仪及线扫激光扫描仪均固定集成在一个刚性平台上，其相对位置及姿态关系保持固定不变，即三维点云(PCD_t1，PCD_t2)之间的粗始相对关系，可由(R₁，T₁)及(R₂，T₂)，直接计算推导，为(R_ret，T_ret)，如公式②；

$\left(\begin{array}{c}{X}_{t2}\\ Y_{t2}\\ Z_{t2}\end{array}\right)=\left(\begin{array}{c}{X}_{t1}\\ Y_{t1}\\ Z_{t1}\end{array}\right)*\left(R_{\mathrm{ret}}\right)+\left(T_{\mathrm{ret}}\right)$ ……………………………………②

其中，(X_t1，Y_t1，Z_t1)为PCD_t1中提取的特征点，(X_t2，Y_t2，Z_t2)为PCD_t2中对应的特征点。

本发明的方法步骤4中所述在三维空间点云对(PCD_t1，PCD_t2)中进行特征选取与匹配，三维空间点云采集的信息比线扫激光扫描获取的点云信息更加丰富，可以提取点、线、面多种特征，通过ICP算法，在给定粗始值(R_ret，T_ret)的情况下，计算出最优参数，从而获取出三维空间点云之间的准确相对参数关系(R_pre，T_pre)，可以将两个点云统一在同一个坐标系下；

本发明的方法步骤5中通过步骤4中计算的精确相对位置关系(R_pre，T_pre)，对步骤2中计算出的粗匹配相对位置关系(R_ret，T_ret)，进行修正，调整整体的粗步相对位置关系，使用精确相对关系，可以提高粗步匹配的相对关系精度，之后再次进行步骤3及步骤4，对其他的三维空间点云对，此时应当不再为(t₁，t₂)时刻，而是其他时刻进行精确匹配，获取更加准确的相对位置关系，之后再次对粗匹配参数进行改正，即完成一次精确匹配后对粗匹配结果进行改正，再次计算，重复迭代，直至所有点云数据(线扫激光扫描仪及三维激光扫描仪获取)均完成精确匹配且参数变化小于规定阈值δ时，方法结束。

本发明基于SLAM原理，将线扫激光扫描仪与地面三维激光扫描仪集成在一个刚性平台上进行数据采集，首先使用线扫激光扫描仪进行采集时间段内的点云数据的粗匹配，然后在时间统一的基准上，将地面三维激光扫描仪获取的点云数据使用ICP算法进行精确配准，迭代改进整个解算过程，最终获取连续精确的空间三维信息。

本发明的方法与现有的技术相比具有如下优点：

1、更高的采集效率。本发明的方法相较于传统的间断式采集，能够减少外业工作量及内业后续处理工作量。

2、自动化程度较高。后续数据配准解算均有很大部分是自动完成。

附图说明

图1为本发明基于SLAM的室内环境空间三维信息连续采集方法的操作流程图。

图2为本发明移动测量系统不同坐标系示意图。

图3为本发明室内环境下移动测量系统采集时坐标相对关系示意图。

上述图中：1-载体坐标系，2-地面三维激光扫描仪局部坐标系，3-前一时刻载体坐标系，4-前一时刻地面三维激光扫描仪局部坐标系，5-下一时刻载体坐标系，6-下一时刻地面三维激光扫描仪局部坐标系，7-室内环境。

具体实施方式

以下结合附图和实施例对本发明作进一步详述。

实施例1：本发明提出的一种室内环境三维空间信息连续采集方法，其操作步骤如图1所示。具体的操作是：首先，使用室内移动测量系统在室内环境下进行采集数据，采集数据过程在载体移动前进中进行，通过线扫激光扫描仪用于获取用于粗匹配的点云数据，地面三维激光扫描仪在载体短暂停止时进行三维扫描获取三维点云数据，同时，记录存储采集的时间信息。定义室内移动测量系统中的载体坐标系，以线扫激光扫描仪中心为坐标系原点，载体行驶的方向为Y轴正方向，垂直向上的方向为Z轴正方向，根据右手坐标系确定X轴方向，地面三维激光扫描仪内部定义三维空间直角坐标系为扫描仪中心为其内部坐标系的原点，在其自身水平情况下采集时第一束激光发射的方向为X轴正方向，垂直向上的方向为Z轴，根据右手坐标系确定Y轴方向，地面三维激光扫描仪的外参数可表示载体坐标系转换至三维激光扫描仪坐标系的变换关系，再按如下步骤操作：

步骤1、选取相邻两个时间段(T_i，T_i+1)，在选取时选取时间间隔应当大于单次整圈线扫时间，一般为整圈线扫时间的整数倍，时间段也不用间隔过大，使得线扫激光扫描仪采集获取的粗匹配点云数据(Pcd_i，Pcd_i+1)，存在同名特征，通过特征提取算法进行特征点选取及匹配，估计两个匹配点云数据的相对位移及姿态估计，建立两个粗匹配点云之间的相对几何关系，用旋转矩阵及偏移量(R₀，T₀)表示，其具体操作为；

1.1、从采集开始的时间中，在第T_i时刻线扫扫描仪获取的点云数据中，使用特征查找算法，查找点云中的多个特征点，获取其在T_i时刻载体坐标系下的三维坐标(X_i，Y_i，Z_i)；

1.2、在第T_i+1时刻线扫扫描仪获取的点云数据中，使用特征查找算法，查找点云中的多个特征点，获取其在T_i+1时刻载体坐标系下的三维坐标(X_i+1，Y_i+1，Z_i+1)；

1.3、进行特征匹配后，按公式①列出方程最小二乘解算，计算出两个时刻载体坐标系之间的相对几何关系，为(R₀，T₀)。

步骤2、重复步骤1，不断进行点云匹配，即选取上一步中下一时间(T_i+1，T_i+2)，计算相对几何关系，那么可以得到(T_i，T_i+2)两个时刻点云之间的相对几何关系，则可建立其整个采集时间范围(T₀，T_n)内获取点云信息的粗步相对几何关系，从而建立其在任意时刻T_i采集的点云数据在粗始坐标系下的位置及姿态信息(R_i，T_i)，其具体操作为：

2.1、在第T_i+2时刻线扫扫描仪获取的点云数据中，使用特征查找算法，查找点云中的多个特征点，获取其在T_i+2时刻载体坐标系下的三维坐标(X_i+2，Y_i+2，Z_i+2)；

2.2、进行特征匹配后，按公式①列出方程最小二乘解算，计算出两个时刻载体坐标系之间的相对几何关系，然后根据前一时间段计算出相对关系，计算出T_i+2与T_i时刻载体坐标系之间的相对几何关系，如此可以逐步推导出在粗始时刻粗始坐标系下的位置和姿态。

2.3、重复2.1及2.2，可以获取整个采集时间段内，任意时刻载体坐标系在粗始坐标系下位置和姿态，从而可以粗步的将所有点云数据进行坐标统一。

步骤3、根据记录的时间信息，查找出地面三维激光扫描仪进行三维空间信息采集的时刻，在外业采集时，地面三维激光扫描仪进行扫描时，载体会处于静止状态，记录下此时的时间，对任意一对地面三维激光扫描获取的三维点云(PCD_t1，PCD_t2)，其对应的时间分别为t₁和t₂，其对应的线扫激光扫描仪的位置和姿态为(R₁，T₁)、(R₂，T₂)。载体系统中，地面三维激光扫描仪及线扫激光扫描仪均固定集成在一个刚性平台上，其相对位置及姿态关系保持固定不变，即三维点云(PCD_t1，PCD_t2)之间的粗始相对关系，可由(R₁，T₁)及(R₂，T₂)，直接计算推导，为(R_ret，T_ret)，其具体操作为：

3.1、对于第t₁时刻，地面三维激光扫描仪获取的点云PCD_t1，根据地面激光扫描仪与线扫激光扫描仪之间固定相对几何关系，可以计算出其在粗始载体坐标系中的位置和姿态(R_t1，T_t1)，如图2所示。

3.2、对于第t₂时刻，可以获取点云PCD_t2在粗始载体坐标系中的位置和姿态(R_t2，T_t2)，则可计算出两者之间的粗始的相对几何关系(R_ret，T_ret)。

步骤4、在三维空间点云对(PCD_t1，PCD_t2)中进行特征选取与匹配，三维空间点云采集的信息比线扫激光扫描获取的点云信息更加丰富，可以提取点、线、面多种特征，通过ICP算法，在给定粗始值(R_ret，T_ret)的情况下，计算出最优参数，从而获取出三维空间点云之间的准确相对参数关系(R_pre，T_pre)，可以将两个点云统一在同一个坐标系下，其具体步骤为：

4.1、在第t₁时刻线扫扫描仪获取的点云数据中，使用特征查找算法，查找点云中的多个特征点，获取其在t₁时刻载体坐标系下的三维坐标(X_t1，Y_t1，Z_t1)；

4.2、在第t₂时刻线扫扫描仪获取的点云数据中，使用特征查找算法，查找点云中的多个特征点，获取其在t₂时刻载体坐标系下的三维坐标(X_t2，Y_t2，Z_t2)；

4.3、根据4.1与4.2中获取的特征，采用ICP算法，给定粗始相对几何关系(R_ret，T_ret)，迭代求解出最优的相对几何位置关系(R_pre，T_pre)，将两者的坐标系进行统一；

步骤5、通过步骤4中计算的精确相对位置关系(R_pre，T_pre)，对步骤2中计算出的粗匹配相对位置关系(R_ret，T_ret)，进行修正，调整整体的粗步相对位置关系，使用精确相对关系，可以提高粗步匹配的相对关系精度，之后再次进行步骤3及步骤4，对其他的三维空间点云对，此时应当不再为(t₁，t₂)时刻，而是其他时刻进行精确匹配，获取更加准确的相对位置关系，之后再次对粗匹配参数进行改正，即完成一次精确匹配后对粗匹配结果进行改正，再次计算，重复迭代，直至所有点云数据(线扫激光扫描仪及三维激光扫描仪获取)均完成精确匹配且参数变化小于规定阈值δ时，完成计算，其具体步骤为：

5.1、根据在第t₁时刻与第t₂时刻精确的相对几何关系(R_pre，T_pre)，替换整体粗匹配集合中的对应时刻的相对位置关系(R_ret，T_ret)，然后逐步调整其他所有时刻的相对几何关系参数，从而获取更新之后的整体粗匹配集合。

5.2、判断是否所有的地面三维激光点云是否均已进行精确配准以及更新湖的整体粗匹配集合与更新之前的集合变化情况，如果存在地面三维激光点云未经过精匹配或者前后集合变化程度小于阈值δ，则重复进行步骤3、步骤4、步骤5.1，否则完成整个过程。

本发明的方法基于SLAM原理，首先通过线扫激光扫描仪获取的点云数据进行相对关系的粗匹配，构建采集时段全部点云数据的粗匹配集合，然后通过地面激光扫描仪获取的点云进行精匹配，之后更新粗匹配集合，迭代进行匹配，最终获取全局最优的精确连续空间三维信息，具有效率高和自动化程度高的特点，具备一定的实用意义。

Claims (6)

1.一种室内环境三维空间信息连续采集方法，使用室内移动测量系统在室内环境下进行采集数据，采集数据过程在载体移动前进中进行，通过线扫激光扫描仪用于获取用于粗匹配的点云数据，地面三维激光扫描仪在载体短暂停止时进行三维扫描获取三维点云数据，同时记录存储采集的时间信息。定义室内移动测量系统中的载体坐标系，以线扫激光扫描仪中心为坐标系原点，载体行驶的方向为Y轴正方向，垂直向上的方向为Z轴正方向，根据右手坐标系确定X轴方向，地面三维激光扫描仪内部定义三维空间直角坐标系为扫描仪中心为其内部坐标系的原点，在其自身水平情况下采集时第一束激光发射的方向为X轴正方向，垂直向上的方向为Z轴，根据右手坐标系确定Y轴方向，地面三维激光扫描仪的外参数可表示载体坐标系转换至三维激光扫描仪坐标系的变换关系，其特征在于：再按如下步骤操作：

步骤1、根据时间信息，选取相邻两个时间段(T_i，T_i+1)，线扫激光扫描仪采集获取的粗匹配点云数据(Pcd_i，Pcd_i+1)，通过特征提取算法进行特征点选取及匹配，估计两个匹配点云数据的相对位移及姿态估计，建立两个粗匹配点云之间的相对位置关系，用旋转矩阵及偏移量(R₀，T₀)表示；

步骤2、重复步骤1，不断进行点云匹配，建立整个采集时间范围内获取点云信息的相对几何关系，从而建立其在任意时刻T_i采集的点云数据在粗始坐标系下的位置及姿态信息(R_i，T_i)；

步骤3、根据记录的时间信息，查找出地面三维激光扫描仪进行三维空间信息采集的时刻，对任意一对地面三维激光扫描获取的三维点云(PCD_t1，PCD_t2)，其对应的时间分别为t₁和t₂，其对应的线扫激光扫描仪的位置和姿态为(R₁，T₁)、(R₂，T₂)。载体系统中，地面三维激光扫描仪及线扫激光扫描仪均固定在一个刚性平台上，其相对位置及姿态关 系保持固定不变，即三维点云(PCD_t1，PCD_t2)之间的粗始相对关系，可由(R₁，T₁)及(R₂，T₂)，直接计算推导，为(R_ret，T_ret)；

步骤4、在三维空间点云对(PCD_t1，PCD_t2)中进行特征选取与匹配，通过ICP算法，在给定粗始值(R_ret，T_ret)的情况下，计算出最优参数，从而获取出三维空间点云之间的准确相对参数关系(R_pre，T_pre)，可以将两个点云统一在同一个坐标系下；

步骤5、通过步骤4中计算的精确相对位置关系(R_pre，T_pre)，对步骤2中计算出的粗匹配相对位置关系(R_ret，T_ret)，进行修正，调整整体的粗步相对位置关系，之后再次进行步骤3及步骤4，对其他的三维空间点云进行精确匹配，获取更加准确的相对位置关系，之后再次对粗匹配参数进行改正，再次计算，重复迭代，直至所有点云数据(线扫激光扫描仪及三维激光扫描仪获取)均完成精确匹配且参数变化小于规定阈值δ时，结束计算。

2.根据权利要求1所述的室内环境空间三维信息连续采集方法，其特征在于：步骤1中所述根据时间信息，选取相邻两个时间段(T_i，T_i+1)，在选取时选取时间间隔应当大于单次整圈线扫时间，一般为整圈线扫时间的整数倍，时间段也不用间隔过大，使得线扫激光扫描仪采集获取的粗匹配点云数据(Pcd_i，Pcd_i+1)，存在同名特征，通过特征提取算法进行特征点选取及匹配，估计两个匹配点云数据的相对位移及姿态估计，建立两个粗匹配点云之间的相对位置关系，用旋转矩阵及偏移量(R₀，T₀)表示，如公式①所示；

…………………………………①

其中，(X_i，Y_i，Z_i)为Pcd_i中提取的特征点，(X_i+1，Y_i+1，Z_i+1)为Pcd_i+1中对应的特征点。

3.根据权利要求1所述的室内环境空间三维信息连续采集方法，其特征在于：步骤2中所述重复步骤1，不断进行点云匹配，即选取上一步中下一时间(T_i+1，T_i+2)，计算相对几何关系，那么可以得到(T_i，T_i+2)两个时刻点云之间的相对几何关系，则可建立其整个 采集时间范围(T₀，T_n)内获取点云信息的粗步相对几何关系，从而建立其在任意时刻T_i采集的点云数据在粗始坐标系下的位置及姿态信息(R_i，T_i)，值得注意是，为了提高后期计算精度，减少传播误差，可以在外业数据采集时通过采用采集闭合路线的方式进行数据采集。

4.根据权利要求1所述的室内环境空间三维信息连续采集方法，其特征在于：步骤3中所述的根据记录的时间信息，查找出地面三维激光扫描仪进行三维空间信息采集的时刻，在外业采集时，地面三维激光扫描仪进行扫描时，载体会处于静止状态，记录下此时的时间，对任意一对地面三维激光扫描获取的三维点云(PCD_t1，PCD_t2)，其对应的时间分别为t₁和t₂，其对应的线扫激光扫描仪的位置和姿态为(R₁，T₁)、(R₂，T₂)。载体系统中，地面三维激光扫描仪及线扫激光扫描仪均固定集成在一个刚性平台上，其相对位置及姿态关系保持固定不变，即三维点云(PCD_t1，PCD_t2)之间的粗始相对关系，可由(R₁，T₁)及(R₂，T₂)，直接计算推导，为(R_ret，T_ret)，如公式②；

……………………………………②

其中，(X_t1，Y_t1，Z_t1)为PCD_t1中提取的特征点，(X_t2，Y_t2，Z_t2)为PCD_t2中对应的特征点。

5.根据权利要求1所述的室内环境空间三维信息连续采集方法，其特征在于：步骤4中所述在三维空间点云对(PCD_t1，PCD_t2)中进行特征选取与匹配，三维空间点云采集的信息比线扫激光扫描获取的点云信息更加丰富，可以提取点、线、面多种特征，通过ICP算法，在给定粗始值(R_ret，T_ret)的情况下，计算出最优参数，从而获取出三维空间点云之间的准确相对参数关系(R_pre，T_pre)，可以将两个点云统一在同一个坐标系下。

6.根据权利要求1所述的室内环境空间三维信息连续采集方法，其特征在于：步骤5中通过步骤4中计算的精确相对位置关系，对步骤2中计算出的粗匹配相对位置关系 (R_ret，T_ret)，进行修正，调整整体的粗步相对位置关系，使用精确相对关系，可以提高粗步匹配的相对关系精度，之后再次进行步骤3及步骤4，对其他的三维空间点云对，此时应当不再为(t₁，t₂)时刻，而是其他时刻进行精确匹配，获取更加准确的相对位置关系，之后再次对粗匹配参数进行改正，即完成一次精确匹配后对粗匹配结果进行改正，再次计算，重复迭代，直至所有点云数据(线扫激光扫描仪及三维激光扫描仪获取)均完成精确匹配且参数变化小于规定阈值δ时，方法结束。