基于多尺度环境感知的激光雷达-惯导 SLAM 参数自适应调节方法

An Adaptive Parameter Adjustment Method for LiDAR-Inertial SLAM Based on Multi-Scale Environmental Perception

  • 摘要: 激光雷达-惯导同步定位与建图(LiDAR-inertial simultaneous localization and mapping,LiDAR-inertial SLAM)利用激光雷达和惯性测量单元的信息对移动平台进行高精度定位和环境建图,是移动机器人自主导航的基础技术之一。目前大多数的LiDAR-inertial SLAM方法使用固定的插入关键帧以及固定的体素网格大小来进行前端的状态估计以及局部的地图维护,当环境中特征均匀稳定时可以获得较好的结果。然而由于环境结构的复杂程度以及观测条件的不同,固定的参数无法满足不同场景下对于特征的需求,容易造成关键帧约束冗余或不足、地图尺度的不一致以及位姿估计的误差增大。为了解决以上问题,本文提出一种基于多尺度环境感知的激光雷达惯导SLAM参数自适应调节方法。首先,建立基于多层次时空邻域的全向曲率度量模型,对激光雷达全景视场点云进行全向特征提取,并结合基于扇区划分的空间几何均衡化机制,分别统计各扇形区域内平均观测距离、有效特征点数以及平均反射强度,得到一个具有方向均衡约束的环境观测向量。其次,利用Haar小波对滑动窗口内环境观测序列进行多尺度分解,提取表征环境整体演化趋势的低频分量和反映局部突变扰动的高频分量,结合趋势—扰动双通道环境状态判别方法,完成环境状态稳定识别。最后,建立环境状态与关键帧插入阈值、体素网格分辨率之间映射关系,结合参数平滑更新方法实现自适应调节。在KITTI和M2DGR数据集中,相比LIO-SAM、FAST-LIO2、Adaptive-LIO等方法,在KITTI Seq.05、Seq.07上ATE-RMSE分别降低约38.35%和31.94%,在多数序列上误差标准差(STD)保持在较低水平,验证了该方法能够有效提升 SLAM 系统的全局地图一致性与定位精度。

     

    Abstract: LiDAR-inertial simultaneous localization and mapping (LiDAR-inertial SLAM) is a fundamental technology for autonomous navigation of mobile robots, which achieves accurate pose estimation and environmental mapping by fusing LiDAR measurements and inertial measurement unit (IMU) information. Existing LiDAR-inertial SLAM methods usually adopt fixed keyframe insertion strategies and fixed voxel grid resolutions for front-end state estimation and local map maintenance. These methods can achieve satisfactory performance in environments with stable feature distributions. However, when the mobile platform moves through scenes with different structural complexity and observation conditions, such as open areas, regular structured spaces, narrow corridors, and transition regions, fixed parameters are difficult to adapt to changing feature constraints. This may cause redundant or insufficient keyframe constraints, mismatched map representation scales, increased computational burden, and decreased pose estimation accuracy. To address these problems, this study proposes an adaptive parameter adjustment method for LiDAR-inertial SLAM based on multi-scale environmental perception. Firstly, an omnidirectional curvature measurement model based on multi-level spatio-temporal neighborhoods is constructed to extract geometric features from panoramic LiDAR point clouds. Combined with a sector-based spatial geometric balancing mechanism, the average observation depth, the number of effective feature points, and the average reflection intensity are statistically calculated in each sector to construct a directionally balanced environmental observation vector. Compared with conventional single-feature environmental description methods, the proposed observation vector provides a more comprehensive representation of environmental characteristics under different structural conditions. Secondly, Haar wavelet decomposition is introduced to analyze the environmental observation sequence in a sliding window. The low-frequency component is used to extract the evolution trend of the environment, while the high-frequency component is used to characterize local disturbances and abrupt changes. Based on this multi-scale representation, a trend-disturbance dual-channel environmental state discrimination mechanism is designed. The trend channel identifies open, normal, and narrow environmental states through low-frequency information, while the disturbance channel detects sudden scene changes by calculating high-frequency disturbance energy. Therefore, the proposed method can continuously track environmental states and avoid unstable parameter switching caused by short-term observation noise. Finally, a mapping relationship between environmental states and the keyframe insertion distance threshold as well as voxel grid resolution is established. Based on the identified environmental state, the corresponding target parameters are generated and updated through a parameter smoothing strategy to achieve adaptive parameter adjustment. The adjusted parameters are synchronously applied to keyframe management and local map construction, thereby improving the adaptability of the LiDAR-inertial SLAM system under complex environmental changes. Experimental results on the KITTI and M2DGR public datasets show that, compared with LIO-SAM, FAST-LIO2, and Adaptive-LIO, the proposed method reduces the absolute trajectory error (ATE-RMSE) by approximately 38.35% on KITTI Seq.05 and 31.94% on Seq.07, while maintaining a lower standard deviation (STD) of trajectory error on most sequences. These results demonstrate that the proposed method effectively improves the global map consistency and pose estimation accuracy of the LiDAR-inertial SLAM system under complex environments.

     

/

返回文章
返回