摘要

鉴于移动机器人三维激光SLAM技术的先进性,探讨激光雷达测距与建图算法,以及其两种改进算法:轻量级及地面优化激光雷达测距与建图(LeGO_LOAM)和LOAM的高级实现算法(A_LOAM),尤其对其低漂移、强实时的特性展开深入研究。通过设计对比实验,对不同SLAM算法的优劣进行分析。搭建移动平台,在实际大尺度室外场景和公开数据集KITTI下,从相对位姿估计误差入手完成对比实验。实验结果证明改进算法相比于LOAM可以达到更小的相对位姿估计误差。

1 引 言

移动机器人（Mobile Robot）相对于固定工作的臂式机器人具有更大的工作范围，是当今机器人研究的热点。同时定位与地图构建（Simultaneous Localization and Mapping, SLAM）技术是移动机器人实现自主移动与定位的关键，得到广泛的研究与应用[1]。与视觉传感器相比，激光雷达可提供更加稳定和准确的信息，不受外部干扰，因此能够为 SLAM 提供一个更为可靠的解决方案。在过去 20 年里基于激光雷达的 SLAM 一直是移动机器人导航研究的基础。随着现代激光 SLAM 技术的发展，三维激光 SLAM成为目前最先进的移动机器人 SLAM 技术之一。主流的三维激光 SLAM 算法有：基于关键点的 LOAM及其改进算法 LeGO_LOAM 和 A_LOAM、LIO；基于数据驱动的 SegMatch 及改其改进算法 SegMap；基于扫描点的 BLAM、IMLS-SLAM、ICP-LO；基于图优化的 Karto SLAM 和 Cartographer 等[2]。张吉等人提出一个低漂移实时激光雷达测距建图算法[3-4]（LidarOdometry and Mapping, LOAM），在公开数据集 KITTI（Karlsruhe Institute of Technology and Toyota Technological Institute）里程计数据集上仅使用激光雷达来估计移动机器人位姿的精度最高的算法[5]，但 LOAM没有闭环检测功能，导致了漂移误差会随时间增加。铁小山等人提出一种轻量级和地面优化的激光雷达测距和建图算法[6]（Lightweight and Ground-OptimizedLidar Odometry and Mapping，LeGO_LOAM），相比于LOAM，在减少计算量的情况下实现了相似或更好的精度及建图工作，其在线执行闭环检测的能力使其成为长时间导航任务的有用工具，但它的闭环检测有时会出现错误或识别遗漏。秦通等人提出了 LOAM的高级实现（Advanced implementation of LOAM, A_LOAM），用 Eigen 和 Ceres Solver 来简化代码结构[7]，相比于 LOAM，代码更为简洁，无需复杂的数学推导和冗余操作。R. Dubé 等人提出了在三维点云中基于分割匹配的位置识别算法[8]（Segment based loopclosure for 3D pointclouds, SegMatch），它可以用在室内和室外环境，然而算法依赖于初始位姿，没有全球定位系统传感器就无法工作。随后 R.Dubé 等人又提出了 SegMatch 的改进算法:使用数据驱动描述子进行 3D 片段建图算法[9]（3D Segment Mapping usingData-Driven Descriptors, SegMap），该算法引入一种新颖的数据驱动的片段描述符，提取的语义信息可以提高对环境变化的鲁棒性，但基于分割匹配的三维激光 SLAM 算法 SegMatch 及其改进算法 SegMap产生的漂移随着时间推移累计成显著漂移。Google在 ICRA 会议上公布了 Cartographer 开源项目[10]，在工程实现上构建了一套完整的室内雷达 SLAM 系统而非简单的算法，其技术框架完整，建图效率很高。文献[11]提出了一种新的基于三维激光雷达数据的SLAM 系统，使用隐式移动最小二乘（IMLS）表面来表示模型，提高了系统鲁棒性。Behley 和 Stachniss提出了一种基于面元的运动估计建图方法 SuMa[12]，该方法允许表示大规模环境并且维护点云的详细几何信息，但是稀疏点云对其是一个挑战。廖瑞杰等人提出了以边匹配为主要依据的基于 K-公共子图判定的室外场景三维点云闭环检测算法并命名为SegGraph[13]，采用公开数据集 KITTI 进行评估，实验结果显示该算法具有良好的准确度和运行效率。除了上述几种传统 SLAM 方法外，研究人员们还研究了使用深度学习的里程估算方法[14-15]，但尚未达到同等水平。

针对上述研究现状及存在的问题，鉴于 LOAM及其改进算法 LeGO_LOAM 和 A_LOAM 是非常低漂移、实时的激光雷达测距方法，以下详细讨论分析新松大尺度室外环境和公开数据集 KITTI 下这三种算法的工作原理和相对位姿估计误差。