Search papers, labs, and topics across Lattice.
This paper introduces a novel SLAM pipeline with provably guaranteed uncertainty quantification using polytopes to represent uncertainty sets for both poses and landmarks. It provides three UQ modules: forward UQ for mapping, backward UQ for pose tracking, and pose compounding, each producing certified uncertainty sets. The method incorporates conformal prediction to calibrate measurement uncertainty, ensuring both theoretical guarantees and practical usability.
Guaranteed uncertainty bounds in SLAM are now tractable and provable, even for full pipelines, thanks to a novel polytopic representation.
In safety-critical robotics applications, guaranteed and practical uncertainty quantification (UQ) in perception is vital. Many existing works either offer no formal containment guarantee, rely on restrictive modeling assumptions, or focus only on pose estimation rather than a complete SLAM pipeline. This paper presents provably guaranteed UQ algorithms for 3D-3D landmark-based SLAM. The algorithms consist of three basic UQ modules: forward UQ for mapping, backward UQ for pose tracking, and pose compound. Each module produces a certified uncertainty set; when the input uncertainty bounds are deterministic, the output sets inherit deterministic guarantees, i.e., they provably contain the true poses and landmarks. Specifically, we use polytopes to represent uncertainty sets, enabling tractable computations and a unified treatment of pose uncertainty. To enhance algorithms' practical usability, we incorporate conformal prediction to calibrate measurement uncertainty from data with prescribed probability. Simulations and experiments demonstrate that the proposed algorithms provide both strong theoretical guarantees and practical usability. The code is open-sourced at https://github.com/LIAS-CUHKSZ/Polytopic-SLAM-Uncertainty-Quantification.
