Track manipulation, locomotion and embodied systems.
Search papers, labs, and topics across Lattice.
GLIO2 addresses critical failure modes in LiDAR-Inertial-GNSS fusion for autonomous systems by introducing a GPU-parallelized, tightly-coupled front-end that jointly optimizes LiDAR-to-multiscan, IMU pre-integration, and raw GNSS measurements within a sliding-window factor graph. This unified optimization framework circumvents scan-to-map drift and the propagation of erroneous pose constraints, enabling robust real-time global localization and mapping even in perceptually degraded or dynamic environments. The system achieves state-of-the-art accuracy across multiple benchmarks and real-world datasets, maintaining high precision at high speeds and on challenging terrains where existing methods diverge.
A single GPU-optimized factor graph fuses LiDAR, IMU, and GNSS to achieve unprecedented real-time global localization accuracy, outperforming baselines that diverge on challenging datasets.
Globally consistent, real-time state estimation in large-scale, perceptually degraded environments is essential for autonomous vehicles and aerial robots, and requires fusing LiDAR, inertial, and GNSS measurements. Existing fusion methods, however, share a scan-to-map front-end with two failure modes. First, each scan is aligned to an incrementally built map that drifts under degeneracy, and once the estimate diverges the error is irrecoverable. Second, even without divergence, a registration biased by dynamic objects or wrong correspondences is propagated as a single pose constraint with an over-confident covariance, leaving its correspondences unavailable for GNSS to re-weight or relinearize. We propose GLIO2, a tightly-coupled LiDAR-Inertial-GNSS system whose GPU-parallel front-end jointly optimizes scan-to-multiscan LiDAR, IMU pre-integration, and raw GNSS measurements in a single sliding-window factor graph, sustaining real-time operation on edge hardware. A complementary offline back-end reuses the same cached factors to refine the entire trajectory in batch, completing the 30-min, 4.51-km UrbanNav Whampoa sequence in about 24 s. Across three public benchmarks (UrbanNav, MARS-LVIG, M3DGR) and self-collected UAV and vehicle data, GLIO2 attains the best overall accuracy among evaluated systems. On a 5.66-km bridge traversed at up to 96 km/h, where every competing baseline diverges under LiDAR degeneracy, it maintains 1.6 m horizontal accuracy. On an NVIDIA Jetson Orin NX, the full pipeline runs at about 25 Hz (39.60 ms per scan). The source code and datasets will be released.