激光惯导紧耦合的户外长距离SLAM算法研究
DOI:
CSTR:
作者:
作者单位:

上海电机学院机械学院 上海 201306

作者简介:

通讯作者:

中图分类号:

TP242.3;TN98

基金项目:


Research on outdoor long range SLAM algorithm with laser inertial guidance tight coupling
Author:
Affiliation:

School of Mechanical Engineering, Shanghai DianJi Univerisity,Shanghai 201306,China

Fund Project:

  • 摘要
  • |
  • 图/表
  • |
  • 访问统计
  • |
  • 参考文献
  • |
  • 相似文献
  • |
  • 引证文献
  • |
  • 资源附件
  • |
  • 文章评论
    摘要:

    针对大多数SLAM算法在户外长距离环境下轨迹误差大、建图漂移问题,提出一种基于IEKF的激光雷达与IMU紧耦合的SLAM算法,并构建全局一致的激光三维点云地图。首先,构建IMU状态模型并通过前向传播预估状态,运用反向传播对点云进行运动补偿,然后采用迭代扩展卡尔曼滤波融合IMU数据与雷达数据,得到前端激光里程计;引入回环检测模块,在点云中构建三角描述符,对三角描述符的边进行匹配以实现闭环检测;最后在后端优化部分采用GTSAM构建因子图,融合IMU预积分因子、里程计因子、回环检测因子,消除累积误差,提高定位精度,降低地图漂移。实验表明,所提算法相较于FAST-LIO2算法在KITTI数据集与自采集数据集中的APE RMSE分别平均下降了50.06%、33.65%,降低了z轴上的漂移,能够构建闭合的稠密点云地图。

    Abstract:

    Aiming at the problem of large trajectory error and map drift of most slam algorithms in outdoor long-distance environment, a SLAM algorithm based on IEKF tightly coupled lidar and IMU is proposed, and a globally consistent laser 3D point cloud map is constructed. Firstly, the IMU state model is constructed and the state is estimated by forward propagation, and the back propagation is used to compensate the motion of the point cloud, and then the IMU data and radar data are fused by iterative extended Kalman filter to obtain the front-end laser odometer; the loop back detection module is introduced to construct the triangle descriptor in the point cloud and match the edges of the triangle descriptor to achieve closedloop detection; finally, in the back-end optimization part, GTSAM is used to build a factor map, which integrates IMU pre integration factor, odometer factor and loop detection factor to eliminate cumulative errors, improve positioning accuracy and reduce map drift. Experiments show that compared with FAST-LIO2 algorithm, the APE RMSE of the proposed algorithm in KITTI data set and self collected data set is reduced by 50.06% and 33.65%, respectively, and the drift on the z axis is reduced, which can build a closed dense point cloud map.

    参考文献
    相似文献
    引证文献
引用本文

孙渊,陈志金,董昊轩.激光惯导紧耦合的户外长距离SLAM算法研究[J].电子测量技术,2025,48(21):157-165

复制
分享
相关视频

文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2025-12-25
  • 出版日期:
文章二维码