arXiv:2507.18317cs.RO2025-07ICRA被引 9

融合雷达、激光雷达与惯性数据,提升复杂环境下的定位精度

AF-RLIO: Adaptive Fusion of Radar-LiDAR-Inertial Information for Robust Odometry in Challenging Environments

  • 动态感知雷达辅助去除非静态点并判断环境退化
  • 基于误差状态卡尔曼滤波实现多源传感器紧耦合
  • 在烟雾、隧道等恶劣场景中优于传统方法

在机器人导航中,复杂动态环境下保持精确位姿估计至关重要。然而,烟雾、隧道和恶劣天气会显著降低单传感器系统(如激光雷达或GPS)的性能,影响自主机器人的稳定性与安全性。为此,我们提出AF-RLIO:一种自适应融合4D毫米波雷达、激光雷达、惯性测量单元(IMU)和GPS的方法,利用多传感器互补优势,实现复杂环境下的鲁棒位姿估计。方法包含三个核心模块:首先,预处理模块利用雷达数据辅助激光雷达去除动态点,并判断激光雷达环境退化状态;其次,动态感知多模态里程计选择合适点云数据进行扫描匹配,并通过迭代误差状态卡尔曼滤波器与IMU紧密耦合;最后,因子图优化模块动态平衡里程计与GPS数据权重,构建位姿图进行优化。该方法在多个数据集及真实机器人环境中验证,结果表明在烟雾、隧道等挑战性场景中显著优于现有方法。

原文摘要 · Abstract (English)

In robotic navigation, maintaining precise pose estimation and navigation in complex and dynamic environments is crucial. However, environmental challenges such as smoke, tunnels, and adverse weather can significantly degrade the performance of single-sensor systems like LiDAR or GPS, compromising the overall stability and safety of autonomous robots. To address these challenges, we propose AF-RLIO: an adaptive fusion approach that integrates 4D millimeter-wave radar, LiDAR, inertial measurement unit (IMU), and GPS to leverage the complementary strengths of these sensors for robust odometry estimation in complex environments. Our method consists of three key modules. Firstly, the pre-processing module utilizes radar data to assist LiDAR in removing dynamic points and determining when environmental conditions are degraded for LiDAR. Secondly, the dynamic-aware multimodal odometry selects appropriate point cloud data for scan-to-map matching and tightly couples it with the IMU using the Iterative Error State Kalman Filter. Lastly, the factor graph optimization module balances weights between odometry and GPS data, constructing a pose graph for optimization. The proposed approach has been evaluated on datasets and tested in real-world robotic environments, demonstrating its effectiveness and advantages over existing methods in challenging conditions such as smoke and tunnels.

多传感器融合定位导航自动驾驶

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