融合曲率拟合运动预测的无人车3D激光高程约束SLAM方法
DOI:
CSTR:
作者:
作者单位:

哈尔滨理工大学自动化学院哈尔滨150080

作者简介:

通讯作者:

中图分类号:

TH85TH242

基金项目:

黑龙江省自然科学基金资助项目(YQ2025F014)、黑龙江省优秀青年教师基础研究支持计划项目(YQJH2025075)资助


Elevation-constrained 3D LiDAR SLAM for autonomous vehicles via ground curvature fitting and motion prediction
Author:
Affiliation:

School of Automation, Harbin University of Science and Technology, Harbin 150080, China

Fund Project:

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

    针对3D激光雷达(LiDAR)在垂直方向上点云稀疏、分辨率不足,导致激光雷达-惯性测量单元(IMU)同时定位与建图(SLAM)系统在高程方向缺乏有效约束、易产生累积漂移的问题,提出一种融合地面曲率拟合运动预测的无人车3D激光高程约束SLAM方法。该方法首先对激光点云进行空间初筛,并结合反射强度信息进行二次筛选,实现对地面点云的稳定分割,为后续地形建模提供可靠数据基础。随后,在无人车实时位姿邻域内,利用最小二乘法对局部地面点云进行二次曲面拟合,从而精确估计地面法向量,并计算反映局部地形整体弯曲特征的平均曲率参数。在此基础上,将地面法向量约束与平均曲率修正相结合,并与无人车的运动预测位移进行正交投影,构建新的高程约束模型,以有效补偿三维激光雷达在垂直方向观测能力不足所带来的不确定性。最后,将激光雷达里程计因子、IMU预积分因子以及所构建的高程约束因子统一引入SLAM系统后端的因子图优化框架中,实现多源传感器信息在物理约束层面的协同优化,在保证系统实时性的同时有效抑制高程方向的累积误差。随后在KITTI公共数据集及高校校园自建数据集上对所提出方法进行了充分实验验证。结果表明,该方法在无人车高程方向具有显著约束效果,相较于基于平滑和建图的紧耦合激光雷达惯性里程计算法(LIO-SAM),定位误差平均值最大降低46.54%,并在地图一致性与轨迹稳定性方面均表现出明显优势。

    Abstract:

    Due to the sparsity and limited vertical resolution of 3D light detection and ranging (LiDAR) point clouds, LiDAR-inertial measurement unit (IMU) simultaneous localization and mapping (SLAM) systems often lack the effective elevation constraints and suffer from the accumulated vertical drift. To address this issue, this paper proposes a 3D LiDAR elevation-constrained SLAM method for autonomous vehicles by integrating ground curvature fitting with motion prediction. Ground points are first segmented with the spatial pre-filtering and reflectivity-based secondary filtering. Then the local ground points are fitted by a quadratic surface to estimate the ground normal vectors and average curvature, which are combined with predicted vehicle motion to construct a novel elevation constraint. The proposed elevation constraint factor together with LiDAR odometry and IMU pre-integration factors is incorporated into a factor graph optimization framework to achieve multi-source collaborative optimization while maintaining the real-time performance. Experiments on the KITTI dataset and a self-collected campus dataset demonstrate that the proposed method provides strong elevation constraints, reducing the average localization error by up to 46.54% compared to the tightly coupled LiDAR-inertial odometry algorithm via smoothing and mapping (LIO-SAM), which significantly improves the map consistency and trajectory stability.

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

栾添添,周塬贺,张秋雨,贲放,孙明晓.融合曲率拟合运动预测的无人车3D激光高程约束SLAM方法[J].仪器仪表学报,2026,47(5):361-369

复制
分享
相关视频

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