FAST-LIO: A Fast, Robust LiDAR-inertial Odometry Package by Tightly-Coupled Iterated Kalman Filter
Not on the map. Why?
Abstract (arXiv)
This paper presents a computationally efficient and robust LiDAR-inertial odometry framework. We fuse LiDAR feature points with IMU data using a tightly-coupled iterated extended Kalman filter to allow robust navigation in fast-motion, noisy or cluttered environments where degeneration occurs. To lower the computation load in the presence of large number of measurements, we present a new formula to compute the Kalman gain. The new formula has computation load depending on the state dimension instead of the measurement dimension. The proposed method and its implementation are tested in various indoor and outdoor environments. In all tests, our method produces reliable navigation results in real-time: running on a quadrotor onboard computer, it fuses more than 1,200 effective feature points in a scan and completes all iterations of an iEKF step within 25 ms. Our codes are open-sourced on Github.
Key facts. Cited by 70 papers in the map (data through 7 Oct 2026). First posted on arXiv 16 Oct 2020.
Builds on
No reference list yet.
Built on by
Citing papers per year: 2021: 2; 2022: 6; 2023: 7; 2024: 20; 2025: 19; 2026: 16.
70 papers.
Sort:
By area:
- 2021R3LIVE: A Robust, Real-time, RGB-colored, LiDAR-Inertial-Visual tightly-coupled state Estimation and mapping packagecited by 49
- 2024FAST-LIVO2: Fast, Direct LiDAR-Inertial-Visual Odometrycited by 40
- 2024CityWalker: Learning Embodied Urban Navigation from Web-Scale Videoscited by 40
- 2025BeamDojo: Learning Agile Humanoid Locomotion on Sparse Footholdscited by 32
- 2023HypLiLoc: Towards Effective LiDAR Pose Regression with Hyperbolic Fusioncited by 24
- 2025VLA-AN: An Efficient and Onboard Vision-Language-Action Framework for Aerial Navigation in Complex Environmentscited by 22
- 2023NTU4DRadLM: 4D Radar-centric Multi-Modal Dataset for Localization and Mappingcited by 17
- 2024Towards Dense and Accurate Radar Perception Via Efficient Cross-Modal Diffusion Modelcited by 17
- 2023Fast and Accurate Deep Loop Closing and Relocalization for Reliable LiDAR SLAMcited by 15
- 2022High-Definition Map Generation Technologies For Autonomous Drivingcited by 14
- 2021Large-scale Autonomous Flight with Real-time Semantic SLAM under Dense Forest Canopycited by 12
- 2024DARE: Diffusion Policy for Autonomous Robot Explorationcited by 11
38 more
- 2025Meta-Memory: Retrieving and Integrating Semantic-Spatial Memories for Robot Spatial Reasoningcited by 9
- 2024Event-Aided Time-to-Collision Estimation for Autonomous Drivingcited by 8
- 2025GS-LIVO: Real-Time LiDAR, Inertial, and Visual Multi-sensor Fused Odometry with Gaussian Mappingcited by 8
- 2024CoSEC: A Coaxial Stereo Event Camera Dataset for Autonomous Drivingcited by 6
- 2024WildLMa: Long Horizon Loco-Manipulation in the Wildcited by 6
- 2025Towards Adaptable Humanoid Control via Adaptive Motion Trackingcited by 6
- 2024OmniColor: A Global Camera Pose Optimization Approach of LiDAR-360Camera Fusion for Colorizing Point Cloudscited by 5
- 2025HeRCULES: Heterogeneous Radar Dataset in Complex Urban Environment for Multi-session Radar SLAMcited by 5
- 2025S-Graphs 2.0 -- A Hierarchical-Semantic Optimization and Loop Closure for SLAMcited by 5
- 2025Diffusion-Based mmWave Radar Point Cloud Enhancement Driven by Range Imagescited by 5
- 2023Efficient Implicit Neural Reconstruction Using LiDARcited by 4
- 2023TransFusionOdom: Interpretable Transformer-based LiDAR-Inertial Fusion Odometry Estimationcited by 4
- 2024NeuV-SLAM: Fast Neural Multiresolution Voxel Optimization for RGBD Dense SLAMcited by 4
- 2025LiDAR-VGGT: Cross-Modal Coarse-to-Fine Fusion for Globally Consistent and Metric-Scale Dense Mappingcited by 4
- 2026AirHunt: Bridging VLM Semantics and Continuous Planning for Efficient Aerial Object Navigationcited by 4
- 2022R3LIVE++: A Robust, Real-time, Radiance reconstruction package with a tightly-coupled LiDAR-Inertial-Visual state Estimatorcited by 3
- 2022ECTLO: Effective Continuous-time Odometry Using Range Image for LiDAR with Small FoVcited by 2
- 2024Event-based Sensor Fusion and Application on Odometry: A Surveycited by 2
- 2026Annotation-Free Detection of Drivable Areas and Curbs Leveraging LiDAR Point Cloud Mapscited by 2
- 2026ActiveFly-Bench: Aligning Embodied Question Answering with Vision-Language-Action for Aerial Embodied Perceptioncited by 2
- 2026Uncertainty-Aware World Model for Aerial Image-Goal Navigationcited by 2
- 2026FMCW-LIO: A Doppler LiDAR-Inertial Odometrycited by 2
- 2022PaGO-LOAM: Robust Ground-Optimized LiDAR Odometrycited by 1
- 2022Collection and Evaluation of a Long-Term 4D Agri-Robotic Datasetcited by 1
- 2023USTC FLICAR: A Sensors Fusion Dataset of LiDAR-Inertial-Camera for Heavy-duty Autonomous Aerial Work Robotscited by 1
- 2023ROSS: Radar Off-road Semantic Segmentationcited by 1
- 2024NeurIT: Pushing the Limit of Neural Inertial Tracking for Indoor Robotic IoTcited by 1
- 2024Monocular Localization with Semantics Map for Autonomous Vehiclescited by 1
- 2024LiVisSfM: Accurate and Robust Structure-from-Motion with LiDAR and Visual Cuescited by 1
- 2025Holistic Fusion: Task- and Setup-Agnostic Robot Localization and State Estimation with Factor Graphscited by 1
- 2025Toward Real-World Cooperative and Competitive Soccer with Quadrupedal Robot Teamscited by 1
- 2026AdaptManip: Learning Adaptive Whole-Body Object Lifting and Delivery with Online Recurrent State Estimationcited by 1
- 2026DreamFlow: Local Navigation Beyond Observation via Conditional Flow Matching in the Latent Spacecited by 1
- 2026Self-Supervised Online Robot-Agnostic Traversability Estimation for Open-World Environmentscited by 1
- 2026Generalized-CVO: Fast and Correspondence-Free Local Point Cloud Registration with Second Order Riemannian Optimizationcited by 1
- 2026A Closed-Loop Multi-Agent Framework for Robust Multi-Robot Manipulationcited by 1
- 2022A Tightly Coupled LiDAR-IMU Odometry through Iterated Point-Level Undistortioncited by 0
- 2024MASSTAR: A Multi-Modal and Large-Scale Scene Dataset with a Versatile Toolchain for Surface Prediction and Completioncited by 0
50 most cited of 70 All 70 (JSON)
- 2026CLoSeR: Closing the Loop for Long-Context Streaming Reconstruction1 Oct 2026
- 2026Free-Init: Scan-Free, Motion-Free, and Correspondence-Free Initialization for Doppler LiDAR-Inertial Systems24 Sep 2026
- 2026FMCW-LIO: A Doppler LiDAR-Inertial Odometry24 Sep 2026
- 2026Uncertainty-Aware World Model for Aerial Image-Goal Navigation6 Aug 2026
- 2026ACME: A Multi-Cultural, Multi-Embodiment Social-Navigation Dataset24 Jul 2026
- 2026ActiveFly-Bench: Aligning Embodied Question Answering with Vision-Language-Action for Aerial Embodied Perception11 Jul 2026
- 2026A Closed-Loop Multi-Agent Framework for Robust Multi-Robot Manipulation8 Jul 2026
- 2026Real-Time LiDAR Gaussian Splatting SLAM5 Jul 2026
- 2026Generalized-CVO: Fast and Correspondence-Free Local Point Cloud Registration with Second Order Riemannian Optimization8 Jun 2026
- 2026Self-Supervised Online Robot-Agnostic Traversability Estimation for Open-World Environments27 May 2026
- 2026Annotation-Free Detection of Drivable Areas and Curbs Leveraging LiDAR Point Cloud Maps29 Mar 2026
- 2026ODD-SEC: Onboard Drone Detection with a Spinning Event Camera6 Mar 2026
38 more
- 2026DreamFlow: Local Navigation Beyond Observation via Conditional Flow Matching in the Latent Space3 Mar 2026
- 2026AdaptManip: Learning Adaptive Whole-Body Object Lifting and Delivery with Online Recurrent State Estimation16 Feb 2026
- 2026AirHunt: Bridging VLM Semantics and Continuous Planning for Efficient Aerial Object Navigation19 Jan 2026
- 2026UMLoc: Uncertainty-Aware Map-Constrained Inertial Localization with Quantified Bounds10 Jan 2026
- 2025VLA-AN: An Efficient and Onboard Vision-Language-Action Framework for Aerial Navigation in Complex Environments17 Dec 2025
- 2025LiDAR-VGGT: Cross-Modal Coarse-to-Fine Fusion for Globally Consistent and Metric-Scale Dense Mapping3 Nov 2025
- 2025Been There, Scanned That: Nostalgia-Driven LiDAR Compression for Self-Driving Cars1 Nov 2025
- 2025Towards Adaptable Humanoid Control via Adaptive Motion Tracking16 Oct 2025
- 2025An Adaptive ICP LiDAR Odometry Based on Reliable Initial Pose26 Sep 2025
- 2025Meta-Memory: Retrieving and Integrating Semantic-Spatial Memories for Robot Spatial Reasoning25 Sep 2025
- 2025Scene-Agnostic Traversability Labeling and Estimation via a Multimodal Self-supervised Framework25 Aug 2025
- 2025ADA-DPM: A Neural Descriptors-based Adaptive Noise Filtering Strategy for SLAM22 Jun 2025
- 2025Toward Real-World Cooperative and Competitive Soccer with Quadrupedal Robot Teams20 May 2025
- 2025SmallPlan: Leverage Small Language Models for Sequential Path Planning with Simulation-Powered, LLM-Guided Distillation1 May 2025
- 2025Holistic Fusion: Task- and Setup-Agnostic Robot Localization and State Estimation with Factor Graphs8 Apr 2025
- 2025Diffusion-Based mmWave Radar Point Cloud Enhancement Driven by Range Images4 Mar 2025
- 2025S-Graphs 2.0 -- A Hierarchical-Semantic Optimization and Loop Closure for SLAM25 Feb 2025
- 2025CAR-LOAM: Color-Assisted Robust LiDAR Odometry and Mapping24 Feb 2025
- 2025BeamDojo: Learning Agile Humanoid Locomotion on Sparse Footholds14 Feb 2025
- 2025HeRCULES: Heterogeneous Radar Dataset in Complex Urban Environment for Multi-session Radar SLAM4 Feb 2025
- 2025FlexCloud: Direct, Modular Georeferencing and Drift-Correction of Point Cloud Maps1 Feb 2025
- 2025GS-LIVO: Real-Time LiDAR, Inertial, and Visual Multi-sensor Fused Odometry with Gaussian Mapping15 Jan 2025
- 2025KN-LIO: Geometric Kinematics and Neural Field Coupled LiDAR-Inertial Odometry8 Jan 2025
- 2024Establishing Reality-Virtuality Interconnections in Urban Digital Twins for Superior Intelligent Road Inspection and Simulation23 Dec 2024
- 2024CCNDF: Curvature Constrained Neural Distance Fields from 3D LiDAR Sequences20 Dec 2024
- 2024CityWalker: Learning Embodied Urban Navigation from Web-Scale Videos26 Nov 2024
- 2024WildLMa: Long Horizon Loco-Manipulation in the Wild22 Nov 2024
- 2024EROAM: Event-based Camera Rotational Odometry and Mapping in Real-time17 Nov 2024
- 2024Cross-modal semantic segmentation for indoor environmental perception using single-chip millimeter-wave radar raw data1 Nov 2024
- 2024LiVisSfM: Accurate and Robust Structure-from-Motion with LiDAR and Visual Cues29 Oct 2024
- 2024Moving Object Segmentation in Point Cloud Data using Hidden Markov Models24 Oct 2024
- 2024DARE: Diffusion Policy for Autonomous Robot Exploration22 Oct 2024
- 2024Event-based Sensor Fusion and Application on Odometry: A Survey20 Oct 2024
- 2024FAST-LIVO2: Fast, Direct LiDAR-Inertial-Visual Odometry26 Aug 2024
- 2024CoSEC: A Coaxial Stereo Event Camera Dataset for Autonomous Driving16 Aug 2024
- 2024Event-Aided Time-to-Collision Estimation for Autonomous Driving10 Jul 2024
- 2024Monocular Localization with Semantics Map for Autonomous Vehicles6 Jun 2024
- 2024A Complete System for Automated 3D Semantic-Geometric Mapping of Corrosion in Industrial Environments21 Apr 2024
50 newest of 70 All 70 (JSON)
- 2024Towards Dense and Accurate Radar Perception Via Efficient Cross-Modal Diffusion Modelcited by 17
- 2024DARE: Diffusion Policy for Autonomous Robot Explorationcited by 11
- 2025Diffusion-Based mmWave Radar Point Cloud Enhancement Driven by Range Imagescited by 5
- 2026DreamFlow: Local Navigation Beyond Observation via Conditional Flow Matching in the Latent Spacecited by 1
- 2026DreamFlow: Local Navigation Beyond Observation via Conditional Flow Matching in the Latent Space3 Mar 2026
- 2025Diffusion-Based mmWave Radar Point Cloud Enhancement Driven by Range Images4 Mar 2025
- 2024DARE: Diffusion Policy for Autonomous Robot Exploration22 Oct 2024
- 2024Towards Dense and Accurate Radar Perception Via Efficient Cross-Modal Diffusion Model13 Mar 2024
- 2021R3LIVE: A Robust, Real-time, RGB-colored, LiDAR-Inertial-Visual tightly-coupled state Estimation and mapping packagecited by 49
- 2024FAST-LIVO2: Fast, Direct LiDAR-Inertial-Visual Odometrycited by 40
- 2024CityWalker: Learning Embodied Urban Navigation from Web-Scale Videoscited by 40
- 2025BeamDojo: Learning Agile Humanoid Locomotion on Sparse Footholdscited by 32
- 2023HypLiLoc: Towards Effective LiDAR Pose Regression with Hyperbolic Fusioncited by 24
- 2023NTU4DRadLM: 4D Radar-centric Multi-Modal Dataset for Localization and Mappingcited by 17
- 2023Fast and Accurate Deep Loop Closing and Relocalization for Reliable LiDAR SLAMcited by 15
- 2022High-Definition Map Generation Technologies For Autonomous Drivingcited by 14
- 2021Large-scale Autonomous Flight with Real-time Semantic SLAM under Dense Forest Canopycited by 12
- 2024Event-Aided Time-to-Collision Estimation for Autonomous Drivingcited by 8
- 2025GS-LIVO: Real-Time LiDAR, Inertial, and Visual Multi-sensor Fused Odometry with Gaussian Mappingcited by 8
- 2024CoSEC: A Coaxial Stereo Event Camera Dataset for Autonomous Drivingcited by 6
12 most cited of 58 All 58 (JSON)
- 2026CLoSeR: Closing the Loop for Long-Context Streaming Reconstruction1 Oct 2026
- 2026Free-Init: Scan-Free, Motion-Free, and Correspondence-Free Initialization for Doppler LiDAR-Inertial Systems24 Sep 2026
- 2026FMCW-LIO: A Doppler LiDAR-Inertial Odometry24 Sep 2026
- 2026ACME: A Multi-Cultural, Multi-Embodiment Social-Navigation Dataset24 Jul 2026
- 2026ActiveFly-Bench: Aligning Embodied Question Answering with Vision-Language-Action for Aerial Embodied Perception11 Jul 2026
- 2026Real-Time LiDAR Gaussian Splatting SLAM5 Jul 2026
- 2026Generalized-CVO: Fast and Correspondence-Free Local Point Cloud Registration with Second Order Riemannian Optimization8 Jun 2026
- 2026Self-Supervised Online Robot-Agnostic Traversability Estimation for Open-World Environments27 May 2026
- 2026Annotation-Free Detection of Drivable Areas and Curbs Leveraging LiDAR Point Cloud Maps29 Mar 2026
- 2026ODD-SEC: Onboard Drone Detection with a Spinning Event Camera6 Mar 2026
- 2026UMLoc: Uncertainty-Aware Map-Constrained Inertial Localization with Quantified Bounds10 Jan 2026
- 2025LiDAR-VGGT: Cross-Modal Coarse-to-Fine Fusion for Globally Consistent and Metric-Scale Dense Mapping3 Nov 2025
12 newest of 58 All 58 (JSON)