基于已知点约束的高精度煤矿巷道三维点云建模方法

关键词：巷道建模；三维激光雷达扫描；同时定位与地图构建；SLAM；已知点约束；三维点云地图

中图分类号：TD67 文献标志码：A

0引言

煤矿智能化是我国煤炭企业高质量发展的核心技术支撑[1-2]，而高精度的时空数据是煤矿智能化的基础。煤矿巷道作为采运装备的重要载体，是矿井实景三维的重要组成部分，也是智慧矿山的空间信息基础，煤矿巷道三维建模对于科学合理地组织各类矿山信息，将海量异质的矿山信息资源进行全面、高效和有序地管理与整合起着重要作用，可为煤矿智能化开采提供精准的三维空间数据支撑[3-4]。

煤矿巷道参数化建模方法主要有以下3 种[5]：借助巷道顶底板中心线数据与断面数据完成巷道建模；借助巷道中心线及顶底板边界线完成巷道建模；利用巷道中心线及边界线来提取高程以完成巷道建模。这3 种方法主要依靠断面特征点、导线点、巷道中心线等数据进行建模，受到特征数据精度影响导致建模精度较低，且不能准确描述巷道边界[6]。随着传感器技术的快速发展，三维激光雷达扫描技术凭借其测量速度快、范围广、精度高等优势，为煤矿巷道高精度三维点云建模开辟了新途径。尤其是激光雷达同时定位与地图构建（Simultaneous Localizationand Mapping，SLAM）技术的快速发展与广泛应用极大地提高了煤矿巷道三维建模的效率[7-10]。H.Kim 等[11]利用编码器和多个激光雷达传感器在水平方向上连续检测巷道壁形状并执行模式匹配，同时叠加垂直方向上的扫描结果，实现了高精度巷道建模。刘敬娜等[12]提出了一种分体分面组合模型自动建模技术，为煤矿巷道建模提供了一种新的技术思路。Wang Jiaheng 等[13]提出了基于体素网格的点云处理与改进的点面匹配方法，并结合地面点云约束的滑动窗口优化，得到了较好的建模结果。刘少杰等[14]提出了一种点云数据与三维栅格映射的掘进巷道空间建模方法，极大地减少了数据处理量。江记洲等[15]将矿山巷道的三维点云数据通过圆柱面投影转换为二维离散点，应用分治算法进行三角剖分，并保存二三维点云与三角网之间的拓扑关系，从而完成三维巷道模型重建。M. J. M. Gurgel 等[16]针对地下不利环境条件使建模技术变得复杂的问题，提出了适用于恶劣条件下的对齐与配准算法，以获得精确的三维模型。

然而，面对煤矿井下低照度、弱纹理、高粉尘等复杂条件，现有煤矿巷道三维建模方法存在成本高、时效性差和精度低等问题。因此，本文提出一种已知点约束的高精度煤矿巷道三维点云建模方法。该方法通过多重优化的前端匹配，将已知点约束信息加入到复杂煤矿巷道激光SLAM 建模中，以校正测站点和全局点云地图坐标，从而提高煤矿巷道三维点云建模精度。

1方法原理

已知点约束的高精度煤矿巷道三维点云建模流程如图1 所示。首先，采集激光雷达点云数据（采集频率10 Hz） 、惯性测量单元（Inertial MeasurementUnit，IMU）数据（采集频率200 Hz）和已知点坐标数据。其次，对激光雷达点云数据与IMU 数据进行处理：对于激光雷达点云数据，利用IMU 预测的位姿对激光雷达运动过程中可能导致的点云畸变进行去除，再通过多重优化对去畸变的激光雷达点云数据进行初步优化，以提高前端配准的精度和效率；对于IMU 数据，通过构建新的预积分观测值用于后端优化。然后，激光SLAM 里程计判断是否添加测站点，并通过附合导线控制测量计算各测站点坐标。最后，将测站点坐标作为约束，利用非线性优化方法校正三维激光点云地图，获得已知点约束的巷道点云三维模型。

1.1数据处理

采用体素滤波器对激光雷达点云数据进行降采样，再针对降采样数据进行多重优化。第1 重优化：结合IMU 提供的加速度和角速度信息对激光雷达运动畸变进行校正， 生成畸变校正点云P， 同时对IMU 数据进行预积分，形成用于后端优化的IMU 因子，为后续的位姿估计提供运动约束。第2 重优化：使用迭代最近点（Iterative Closest Point，ICP）[17]对降采样的激光雷达点云数据进行配准，形成局部点云Q，再将畸变校正点云P 与局部点云Q 进行ICP 配准，形成激光雷达因子，通过2 次加入ICP 配准，加强了对环境点云的约束。第3 重优化：结合激光雷达点云数据和IMU 数据，计算当前帧与前一帧之间的运动变化，生成里程计因子。将激光雷达因子、IMU 因子和里程计因子融入到因子图中实现状态更新，在后端采用Scan Context 技术[18]加入回环检测以纠正累计漂移。

1.2测站点坐标确定

为确定测站点间的距离，通过大量实验对多种巷道结构和场景中不同测站点间距下的SLAM 定位精度进行评估，发现当测站点间距控制在90 m 以内时，SLAM 定位误差能够保持在一个相对较低且可接受的范围内，生成的点云地图具有较高的精度。因此，每隔一定时间计算激光雷达所在位置与初始位置的大致距离，若达到90 m，则在此位置附近生成的地图点上确定1 个测站点，这样每隔90 m 寻找1 个测站点作为约束，直至扫描结束。

附合导线控制测量始于一个已知点或已知边，向外延伸经过若干未知点，最终到达另一个已知点或已知边，通过平差计算可以得到未知点的平面坐标[19]。附合导线控制测量原理如图2 所示。已知点A、点B、点C、点D的坐标，假设点A、点B与点C、点D中间有3个测站点，若测量方向为从点A、点B出发向点C、点D方向前进，则测得的前后测站点夹角为前进方向的右侧角度。通过已知点的坐标方位角和测得的右侧角度，可递推计算出测站点的坐标方位角。

以观测边EF为例，其坐标方位角为

式中α_BE为观测边BE的坐标方位角。

2实验与分析

2.1实验场景

采用GO−SLAM 手持式三维激光扫描仪在煤矿井下进行实验数据采集。扫描仪参数：扫描距离为120 m；扫描范围为360°×285°；扫描速度为65 万点/s；激光线数为32。实验场景为实验室模拟巷道和真实煤矿巷道，如图3 所示（图中红色三角形位置为数据采集的起点，蓝色路线表示数据采集路径），数据采集路径长度分别为286，1 352 m。

2.2定性分析

将本文方法与主流方法LeGO−LOAM[20]、LIO−SAM[21]在实验室模拟巷道中的建图结果进行对比，如图4 所示。可看出LeGO−LOAM 方法由于在地图构建过程中约束不足，导致实验室模拟巷道建图的起点与终点位置偏差较大，即使有回环检测约束仍不能实现精准建图； LIO−SAM 方法建图效果较好，建图起点与终点位置偏差较小，但竖直方向的偏差较大；本文方法建图的完整性和一致性更好，精度较LeGO−LOAM 与LIO−SAM 有较明显的提高。

为进一步验证本文方法的有效性，在真实煤矿巷道对添加已知点约束前后的建图结果进行对比，如图5 所示。可看出在未添加已知点约束的情况下，煤矿巷道点云地图出现较大偏差；而添加已知点约束的煤矿巷道点云地图具有较好的全局一致性，有效降低了点云地图的偏差。

2.3定量分析

2.3.1定位精度

为定量分析本文方法的定位精度，将不同方法定位结果进行对比，如图6 所示。可看出本文方法定位结果与参考值最接近，而LeGO−LOAM 方法与LIO−SAM 方法定位结果与参考值相差较大；在实验的前半段，由于巷道较宽，不存在激光点云被遮挡，且环境特征信息丰富，因此3 种方法定位精度均接近参考值；在实验的最后，由于巷道狭窄，环境特征信息减少，LeGO−LOAM 方法与LIO−SAM 方法定位偏差较大，而本文方法定位结果与参考值拟合程度较高。

不同方法的定位误差见表1。可看出本文方法在水平方向上最大误差仅为0.426 m，平均误差为0.199 m，竖直方向最大误差为1.044 m，平均误差为0.455 m；而LeGO−LOAM 方法和LIO−SAM 方法的各类误差均大于本文方法，表明本文方法具有较高的定位精度。

2.3.2点云地图精度

为定量分析本文方法构建的三维点云地图精度，在实验场景用卷尺测量多种特征地物的尺寸，并将不同方法构建的三维点云地图导入点云数据处理软件，测量点云地图中对应特征地物的尺寸，如图7所示。将卷尺实测尺寸与通过不同方法构建的三维点云地图测量的尺寸进行对比，结果见表2。

从表2 可看出， LeGO−LOAM方法在特征地物1 处的误差最大，在各种特征地物处的平均相对误差为3.40%；LIO−SAM方法相较于LeGO−LOAM方法精度有所提升，平均相对误差为1.37%；本文方法在各种特征地物处的绝对误差和相对误差均小于LeGO−LOAM及LIO−SAM 方法， 平均相对误差为0.55%， 表明本文方法构建的三维点云地图精度较高。

3结论

1） 提出了一种基于已知点约束的高精度煤矿巷道三维点云建模方法。对激光雷达点云数据进行多重优化，提高了前端配准的精度和效率；利用附合导线控制测量获取分段已知点，为三维激光点云建模提供全局约束条件；结合已知点和激光SLAM 确定的测站点进行联合平差计算，利用非线性优化方法进一步校正全局点云地图，从而提高三维点云建模精度。

2） 实验结果表明，该方法构建的煤矿巷道三维点云地图具有较好的全局一致性和几何结构真实性，在煤矿井下具有较高的定位与建图精度。