FAST-LIO2: Fast Direct LiDAR-Inertial Odometry

FAST-LIO2: Fast Direct LiDAR-Inertial Odometry

Wei Xu, Yixi Cai, Dongjiao He, Jiarong Lin, Fu Zhang · The University of Hong Kong · 2022

Framework

ROS / C++

License

MIT

Stars

4,707

Summary

A tightly-coupled LiDAR-inertial odometry system with incremental kd-tree mapping, enabling real-time state estimation for UAVs and mobile robots.

Abstract Summary

FAST-LIO2 is a highly efficient direct LiDAR-inertial odometry framework built on top of ikd-Tree, a novel incremental kd-tree data structure. It addresses the fundamental challenge of real-time 3D state estimation in dynamic environments by tightly fusing LiDAR point clouds and IMU measurements through an iterated Kalman filter. The system is designed to operate onboard UAVs and ground robots, providing centimeter-level localization accuracy at well above sensor frame rates. The key innovation of FAST-LIO2 lies in its incremental kd-tree mapping backend, which enables direct point cloud registration without requiring explicit feature extraction. By incrementally updating the map structure as new points arrive, the system avoids the costly global map- rebuilding bottleneck of traditional dense approaches. This makesFAST-LIO2 particularly well-suited for high-rate LiDAR sensors such as the Livox Mid-360, where point densities vary dramatically across the field of view. From a systems perspective, the codebase is lightweight, well-structured, and extensively tested on both aerial and legged platforms. The repository includes ROS wrappers, launch files, and configuration examples for several popular LiDAR models (Livox, Ouster, Velodyne). The ikd-Tree component is maintained as a standalone library, making it reusable in other geometric pipelines beyond odometry. Real-world benchmarks demonstrate that FAST-LIO2 achieves state-of-the-art accuracy while running at over 100 Hz on a portable computation unit. The broader impact is significant for autonomous navigation: accurate real-time odometry is the foundation of localization, mapping, and loop closure. FAST-LIO2 is widely adopted in the UAV research community and serves as the default odometry backend for several well-known mapping systems (such as R3LIVE and FAST-LIVO). Its efficiency and robustness make it an excellent starting point for researchers entering the LiDAR-inertial SLAM space.

Key Points

  • Tightly-coupled iterated Kalman filter fusing LiDAR and IMU at high frequency.
  • Novel incremental ikd-Tree enables fast direct point registration without feature extraction.
  • Runs at over 100 Hz onboard UAVs; tested on Livox, Ouster, and Velodyne sensors.
  • Open-source ROS package with modular C++ backend and standalone ikd-Tree library.
  • Widely adopted as odometry core in aerial, legged, and mobile manipulation platforms.

Additional Notes

Setup Tips

  • For Livox sensors, use the official Livox ROS driver and check LiDAR firmware compatibility.
  • Increase CPU governor to performance mode for consistent real-time performance.
  • When mapping very large environments, tune mapping buffer size to avoid memory growth.
  • FAST-LIO (Xu et al., ICRA 2022)
  • R3LIVE (Lin et al., ICRA 2022)
  • ikd-Tree (Cai et al., RAL 2021)
Share

Related Papers

AIR-VLA+: Decoupling Movement and Manipulation via Cascaded Dual-Action Decoders with Asymmetric MoE for Aerial Robots

AIR-VLA+: Decoupling Movement and Manipulation via Cascaded Dual-Action Decoders with Asymmetric MoE for Aerial Robots

Jianli Sun, Bin Tian, Qiyao Zhang et al. · arXiv preprint · Jun 2026

Aerial manipulation systems have long suffered from representation coupling in end-to-end control, as platform-level Unmanned Aerial Vehicle (UAV) movement and end-effector-level arm manipulation differ substantially in action scale, dynamics, and control objectives. In this paper, we propose AIR-VL...

uav vla manipulation
PDF Advanced
No code repo Jun 2026
DynaFLIP: Rethinking Robotics Perception via Tri-Modal-Dynamics Guided Representation

DynaFLIP: Rethinking Robotics Perception via Tri-Modal-Dynamics Guided Representation

Jusuk Lee, Seungjae Lee, Jonghun Shin et al. · arXiv preprint · May 2026

Robot manipulation critically depends on perception that preserves the action-relevant aspects of a scene. Yet most robot learning pipelines are built upon visual encoders pre-trained for static recog

foundation-models perception manipulation representation-learning vla
PDF Intermediate
No code repo Code updated: May 2026