基于时间距离-熵减策略的同步定位与地图构建算法

来源：信息与控制杂志2023年第5期北京时间：

作者：李维刚, 钟正, 王永强, 余楚翔

摘要：针对LIO-SAM (lidar inertial odometry-smoothing and mapping)算法在小范围室外建图时后端基于距离和时间阈值的回环检测存在误检测、重复检测的问题，本文提出一种基于时间距离—熵策略改进后端回环检测的TDE-LIO-SAM (LIO-SAM based on time distance-entropy reduction strategy)算法。该算法首先通过距离阈值和时间阈值初步筛选出备选的回环，然后根据回环点云的熵值减少量来确定最终的匹配回环，同时考虑到TDE-LIO-SAM在实际工程中的应用，引入了一种针对六轴IMU (惯性测量单元)快速重力对齐方法，使LIO-SAM在使用6轴IMU时也能快速进行重力对齐，进一步提高了算法对不同规格传感器的适用性。在开源KITTI数据集和自采数据集下进行实验，实验结果表明改进后TDE-LIO-SAM算法相较于LIO-SAM算法回环误匹配数量显著减少，定位精度提升8%以上，在KITTI07数据集上绝对定位精度达到5 cm以内。

关键词：同步定位与地图构建, 回环检测, 熵值, 重力对齐