Search papers, labs, and topics across Lattice.
This paper introduces FAST-LIVGO, a robust LiDAR-Inertial-Visual-GNSS fusion framework that addresses the challenges of state estimation and mapping in dynamic environments. By employing an Error-State Iterated Kalman Filter and a novel online spatiotemporal alignment module using Dynamic Time Warping, the system effectively mitigates drift and outlier issues that plague existing LIVO systems. Experimental results show that FAST-LIVGO significantly enhances accuracy and robustness, outperforming current state-of-the-art methods on both the M3DGR dataset and a custom UAV dataset.
Achieving millimeter-level precision in state estimation, FAST-LIVGO outperforms existing methods by effectively handling dynamic conditions and degeneracy in odometry.
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.
