arXiv:2606.19190cs.RO2026-06中稿 · presentation at th…被引 1

融合激光、惯性、视觉与GNSS,提升长时大范围动态环境下的定位精度与鲁棒性。

FAST-LIVGO: A Degeneracy-Robust LiDAR-Inertial-Visual-GNSS Fusion Odometry

论文配图:FAST-LIVGO: A Degeneracy-Robust LiDAR-Inertial-Visual-GNSS Fusion Odometry
图 1 · 摘自论文原文
  • 基于误差状态迭代卡尔曼滤波,实现多传感器紧耦合融合。
  • 在20 m/s无人机数据集上显著降低累积漂移和地图伪影。
  • 动态场景下自动切换故障应对策略,适合高动态无人系统使用。

在长期、大尺度、高度动态的环境中实现鲁棒的状态估计与建图仍是机器人领域的关键挑战。现有激光-惯性-视觉里程计(LIVO)系统虽具备强局部精度,但长时间运行后易产生累积漂移,且在几何退化或无纹理场景中失效。同时,依赖LIVO进行状态预测与异常值剔除的GNSS融合框架,在里程计退化时亦易失效。为此,本文提出一种基于误差状态迭代卡尔曼滤波的紧耦合激光-惯性-视觉-GNSS融合框架。引入基于动态时间规整(Dynamic Time Warping)的在线时空对齐模块,以适应高度动态条件。为更好利用GNSS精度,设计基于多普勒频移与固定锚点差分载波相位的观测模型,实现毫米级相对约束,无需扩展历史锚点状态。进一步提出一种退化感知的双模式异常值剔除策略,根据LIVO退化程度自动切换至基于LIVO先验的剔除或基于GNSS的恢复模式。在公开M3DGR数据集及自建20 m/s固定翼无人机数据集上的实验表明,本系统有效减少累积漂移与地图伪影,在精度与鲁棒性上优于当前最优方法。

原文摘要 · Abstract (English)

Robust state estimation and mapping in long-term, large-scale, and highly dynamic environments remains a key challenge in robotics. Existing LiDAR-Inertial-Visual Odometry (LIVO) systems achieve strong local accuracy but suffer from accumulated drift over long distances and may fail in geometrically degraded or textureless scenes. Meanwhile, GNSS-aided fusion frameworks often rely on LiDAR or visual odometry for state prediction and outlier rejection, making them vulnerable when odometry degenerates. To address these limitations, we propose a tightly coupled LiDAR-Inertial-Visual-GNSS fusion framework based on an Error-State Iterated Kalman Filter. An online spatiotemporal alignment module using Dynamic Time Warping is introduced for highly dynamic conditions. To better exploit GNSS precision, we develop observation models based on Doppler shifts and fixed-anchor Time-Differenced Carrier Phase, providing millimeter-level relative constraints without augmenting historical anchor states. We further design a degeneracy-aware dual-mode outlier rejection strategy that switches between LIVO-prior-guided rejection and GNSS-aided recovery according to the LIVO degeneracy level. Experiments on the public M3DGR dataset and a custom 20~m/s fixed-wing UAV dataset demonstrate that our system reduces accumulated drift and map ghosting, outperforming state-of-the-art methods in accuracy and robustness.

多传感器融合定位里程计无人机导航高动态环境

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