基于自适应体素地图的紧耦合激光惯性里程计

Tightly-coupled LiDAR-inertial Odometry Based on Adaptive Voxel Map

  • 摘要: 为提高机器人在非平整地面如楼梯、丘陵等复杂环境下的精确导航能力,克服现有激光惯性里程计在Z轴易出现较大累积误差漂移、地图质量低等问题,提出了一种基于自适应体素特征地图的紧耦合激光惯性里程计算法。首先,基于八叉树和哈希索引对环境进行自适应网格划分,并通过构建体素特征地图实现对点云特征数据的高效管理和索引;其次,基于体素特征地图,采用直接对体素栅格进行特征索引的方法进行当前帧的特征提取,减少不必要的重复特征拟合,提高位姿估计模块中特征提取与拟合的鲁棒性和效率;最后,引入共视体素栅格的概念,即当滑动窗口中多帧点云对同一个体素栅格形成共同观测时,构建基于滑动窗口的BA(光束平差)优化问题,同时对滑动窗口内的所有位姿进行调整,并对扩展卡尔曼滤波状态估计所维护的状态量进行更新。在公开数据集和真实场景下进行实验验证,结果表明,相比于传统算法,本文算法有效抑制了机器人在Z轴上的累积误差,并且算法输出的机器人行驶轨迹与环境地图都具有较好的全局一致性。

     

    Abstract: To enhance the precise navigation capability of robot in complex environments with uneven terrain such as stairs and hills, and overcome issues in existing LiDAR-inertial odometry systems including significant cumulative error drift along Z-axis and low-quality map, a tightly coupled LiDAR-inertial odometry based on an adaptive voxel feature map is proposed. Firstly, the environment is adaptively partitioned into grids using an octree and Hash indexing, enabling efficient management and indexing of point cloud feature data through the construction of a voxel feature map. Then, a direct voxel-based feature indexing method is employed for feature extraction from the current frame based on the voxel feature map, avoiding redundant feature fitting, which improves the robustness and efficiency of feature extraction and fitting in the pose estimation module. Finally, the concept of co-visible voxel grids is introduced. When the same voxel grid is observed jointly by multiple frames in a sliding window, a sliding window-based bundle adjustment (BA) optimization problem is formulated, to adjust all poses within the window and update the states maintained by the extended Kalman filter based state estimation. Experiments on public datasets and in real-world scenarios demonstrate that the proposed method effectively mitigates cumulative errors along the Z-axis, achieving better global consistency for both trajectories and maps compared to traditional algorithms.

     

/

返回文章
返回