arXiv:2509.14999cs.RO2025-09

融合语义与多传感器数据,实现超大动态环境下的高精度定位

Semantic-LiDAR-Inertial-Wheel Odometry Fusion for Robust Localization in Large-Scale Dynamic Environments

  • 采用语义体素地图与改进扫描匹配算法,减少长期轨迹漂移
  • 多传感器紧耦合滤波,实测在百万平米港口运行3575小时无异常漂移
  • 自适应调整轮速里程计权重,适配复杂地形与动态干扰

在超大规模动态环境中实现可靠、无漂移的全局定位对自主导航至关重要。本文提出一种紧耦合的语义-激光-惯性-轮速里程计融合框架,旨在提供高精度状态估计与鲁棒定位。该框架采用高效的语义体素地图表示,并引入基于全局语义信息的改进扫描匹配算法,显著降低长期轨迹漂移。同时,通过紧耦合的多传感器融合迭代误差状态卡尔曼滤波器(iESKF),无缝融合激光雷达、惯性测量单元(IMU)和轮速里程计数据,确保定位稳定不发散。针对地形变化与动态干扰,设计了三维自适应缩放策略,动态调节轮速里程计的测量权重,进一步提升定位精度。本研究在面积达一百万平方米的自动化港口开展大量实地实验,涵盖35辆智能导引车(IGVs)累计3,575小时的运行数据。结果表明,该系统在大规模动态环境下持续优于现有先进激光定位方法,验证了其可靠性与实际应用价值。

原文摘要 · Abstract (English)

Reliable, drift-free global localization presents significant challenges yet remains crucial for autonomous navigation in large-scale dynamic environments. In this paper, we introduce a tightly-coupled Semantic-LiDAR-Inertial-Wheel Odometry fusion framework, which is specifically designed to provide high-precision state estimation and robust localization in large-scale dynamic environments. Our framework leverages an efficient semantic-voxel map representation and employs an improved scan matching algorithm, which utilizes global semantic information to significantly reduce long-term trajectory drift. Furthermore, it seamlessly fuses data from LiDAR, IMU, and wheel odometry using a tightly-coupled multi-sensor fusion Iterative Error-State Kalman Filter (iESKF). This ensures reliable localization without experiencing abnormal drift. Moreover, to tackle the challenges posed by terrain variations and dynamic movements, we introduce a 3D adaptive scaling strategy that allows for flexible adjustments to wheel odometry measurement weights, thereby enhancing localization precision. This study presents extensive real-world experiments conducted in a one-million-square-meter automated port, encompassing 3,575 hours of operational data from 35 Intelligent Guided Vehicles (IGVs). The results consistently demonstrate that our system outperforms state-of-the-art LiDAR-based localization methods in large-scale dynamic environments, highlighting the framework's reliability and practical value.

定位融合多传感器自动驾驶语义建图

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。