面向煤矿巷道环境的LiDAR与IMU融合定位与建图方法

作者

马艾强姚顽强蔺小虎张联队郑俊良武谋达杨鑫
单位

西安科技大学测绘科学与技术学院陕西彬长矿业集团有限公司
摘要

针对煤矿井下喷浆表面、对称巷道等引起移动机器人自主导航定位与建图失效问题，提出了一种面向煤矿巷道环境的激光雷达(LiDAR)与惯性测量单元(IMU)融合的实时定位与建图方法。首先对原始点云进行分割，利用IMU预积分位姿去除原始点云非线性运动畸变，并对得到的点云进行线、面特征提取。然后将相邻帧的线、面特征进行匹配，在分层位姿估计过程中融合IMU预积分所得到的位姿初值，减少计算迭代次数，提高特征点匹配的精度，解算出当前帧的位姿。最后向因子图中插入局部地图因子、IMU因子、关键帧因子，对位姿进行优化约束，对关键帧与局部地图进行匹配，通过八叉树结构实现地图构建。为验证所提方法的定位性能与建图效果，搭建了Autolabor、VLP-16 LiDAR和Ellipse-N IMU的实验平台进行验证，并与LeGO-LOAM、LIO-SAM方法进行定性定量对比分析。结果表明：(1)在煤矿巷道环境中，面向煤矿巷道环境的LiDAR与IMU融合的实时定位与建图方法三轴方向的绝对定位误差的均值和中值均小于32 cm；对X轴的位姿估计精度最高，其累计误差为1.65 m，位置偏差为2.97 m，建图效果整体良好，建图轨迹未发生漂移；构建的点云地图在完整性和几何结构真实性方面均有着优秀的表现，可以直观反映巷道环境的实际情况，具有良好的鲁棒性。这是因为点云匹配之后进行了分层位姿估计，多因子优化可有效降低全局累计误差，对轨迹精度和地图的一致性提升具有重要作用。(2)在楼道走廊环境中，面向煤矿巷道环境的LiDAR与IMU融合的实时定位与建图方法三轴的误差均小于1.01 m，误差均值为5～15 cm，误差范围小，精度高；累计位置偏差仅为1.67 m；完整性与环境匹配均有良好的性能。这是由于通过增加关键帧因子，插入因子图对其新增节点相关变量进行优化，降低了位姿估计漂移，定位与建图精度相对较高。
关键词

煤矿巷道移动机器人激光雷达惯性测量单元融合定位与建图因子图优化关键帧因子 SLAM
基金项目(Foundation)

国家自然科学基金项目(42001417)；国土资源部煤炭资源勘查与综合利用重点实验室项目(KF2021-4)；
文章目录

0 引言
1 SLAM基本框架
2 基于特征点匹配的相对位姿估计
2.1 预处理
2.2 激光里程计
3 多因子联合图优化及地图构建
3.1 关键帧因子提取
3.2 多因子位姿优化及地图构建
4 实验结果和分析
4.1 实验设备及数据介绍
4.2 实验结果分析
4.2.1 定位精度分析
4.2.2 建图效果分析
5 结论
引用格式

马艾强,姚顽强,蔺小虎,张联队,郑俊良,武谋达,杨鑫.面向煤矿巷道环境的LiDAR与IMU融合定位与建图方法[J].工矿自动化,2022,48(12):49-56.DOI:10.13272/j.issn.1671-251x.2022070007.
相关文章

[1]煤矿井下移动机器人多传感器自适应融合SLAM方法
[2]基于已知点约束的高精度煤矿巷道三维点云建模方法