자율주행 리서치 - FAST-LIO (HKU MARS Lab, RA-L 2021 → T-RO 2022): '특징점 추출을 지우고 원시 점을 맵에 직접 꽂았다' — 상태 차원에 비례하는 칼만 이득 + 증분 k-d 트리 ikd-Tree로 100 Hz·25 ms LiDAR-관성 오도메트리를 만든 ⭐5,275 표준 구현체 (GPL-2.0 · ARM 보드까지)

2026-10-15

주제 정보

  • 논문 ①(원판): “FAST-LIO: A Fast, Robust LiDAR-Inertial Odometry Package by Tightly-Coupled Iterated Kalman Filter” — arXiv 2010.08196(v1 2020-10-16 · v3 2021-04-14) · IEEE RA-L 2021 vol. 6 no. 2 pp. 3317–3324(DOI 10.1109/LRA.2021.3064227) · 분야 cs.RO. 즉 “라이다-관성 오도메트리를 얼마나 싸게 계산할 수 있는가”라는 한 줄 문제를 다룬 8쪽짜리 레터다.
  • 논문 ②(사실상의 본편): “FAST-LIO2: Fast Direct LiDAR-inertial Odometry” — arXiv 2107.06829(2021-07-14) · IEEE T-RO 2022 vol. 38 no. 4 pp. 2053–2073(DOI 10.1109/TRO.2022.3141876). 저장소(main 브랜치)가 구현하는 것은 이 2.0이며, README도 “FAST-LIO 2.0 (2021-07-05 Update)”를 본체로 안내한다 — 1.0은 레터, 2.0이 트랜잭션인 구조다.
  • 저자·소속: Wei Xu(徐威) · Fu Zhang(張富)(Hong Kong University, MARS Lab) — 2.0에는 Yixi Cai(蔡逸熙) · Dongjiao He(賀東嬌) · Jiarong Lin(林家榮)가 추가된다. HKU 기계공학과의 MARS Lab은 라이다-관성 계열(Point-LIO ⭐1,356 · LiDAR_IMU_Init ⭐1,527 · FAST-LIVO2 ⭐4,753)을 연속 배출한 연구실이다.
  • 인용(인덱스별 차이가 큼): FAST-LIO — Semantic Scholar 1,187회 · Crossref 1,137회 · OpenAlex 1,127회. FAST-LIO2 — OpenAlex 1,750회 · Crossref 1,773회(이 시리즈는 숫자를 인덱스 이름과 함께 적는다 — S2는 오늘 FAST-LIO2 조회에서 429를 반환해 표에서 제외했다). 레터 한 편과 트랜잭션 한 편이 합쳐 약 2,900회를 넘긴 셈이다.
  • 공식 저장소: hku-mars/FAST_LIO — ⭐ 5,275 · 🍴 1,723 · 워처 59 · 열린 이슈 1개 · C++ · GPL-2.0 · 생성 2020-10-12 · 최근 푸시 2025-01-15 · 기여자 11명 · 토픽 lidar-odometry·livox-avia-lidar. 의존성은 ROS(>= Melodic) · PCL(>= 1.8) · Eigen(>= 3.3.4) · livox_ros_driver — 거대한 딥러닝 스택 없이 C++와 기하만으로 도는 저장소라는 점이 특징이다.
  • 성능 주장(초록·README 원문): 쿼드로터 온보드 컴퓨터에서 한 스캔당 유효 특징점 1,200개 이상을 융합하고 iEKF 한 스텝의 모든 이터레이션을 25 ms 안에 완료(RA-L 1.0) · README는 2.0에서 “over 100Hz LiDAR rate”를 명시 · ARM 보드 지원(Khadas VIM3 · NVIDIA TX2 · Raspberry Pi 4B 8GB). 회전형(Velodyne · Ouster)과 고체형(Livox Avia · Horizon · MID-70) 라이다를 모두 지원한다.
  • 직접 계보(같은 연구실/저자): ikd-Tree ⭐813(arXiv 2102.10808, Cai·Xu·Zhang) — FAST-LIO2의 맵 자료구조 그 자체 · IKFoM ⭐570(매니폴드 위 iEKF 툴박스) · R2LIVE ⭐783(라이다+관성+비전) · MARSIM ⭐588(라이다 UAV 시뮬레이터, 2025-10-25 푸시). 한 논문이 아니라 “라이다 관성 계열 전체”의 뿌리라는 뜻이다.
  • 함께 읽기(블로그 계보 — SLAM 3부작): 실시간 SLAM의 출발점 Google Cartographer(09-03, 2D/3D 그래프 SLAM) → 카메라·IMU 진영 ORB-SLAM3(10-13, 스테레오-관성 3.5 cm) → 오늘의 FAST-LIO(10-15, 라이다-관성 필터 기반 100 Hz). 인지·지도 쪽 접점은 KITTI(09-11, 라이다 벤치마크 원조) · CenterPoint(09-10) · BEVFusion(10-08), 그리고 위치추정이 올라가는 실차 스택은 Autoware(08-13)다.

핵심 내용

논문의 주장은 한 문장으로 줄어든다. “라이다-관성 오도메트리의 병목은 정확도가 아니라 계산 구조였다.” 한 스캔에는 수천 개의 점이 있고, 전통적인 EKF는 측정 차원만큼 큰 행렬을 다뤄야 한다. FAST-LIO는 칼만 이득을 구하는 공식을 바꿔 계산량을 상태 차원에 묶고, 2.0에서는 특징점 추출이라는 손으로 설계한 모듈을 아예 삭제한다. 그 결과가 “CPU·임베디드에서 100 Hz, iEKF 전 이터레이션 25 ms”다.

왜 유명한가 / 활용 가치

시사점 및 결론

FAST-LIO가 남긴 교훈은 “성능은 알고리즘 아이디어보다 계산 구조에서 나온다”는 것이다. 칼만 이득 계산량을 측정 차원에서 상태 차원으로 옮기고(1.0), 손으로 설계한 특징 추출기를 지운 뒤(2.0), 맵을 증분 k-d 트리로 유지하는(ikd-Tree) 세 결정은 모두 수식의 미학이 아니라 시스템 설계다. 그 결과가 쿼드로터 온보드 컴퓨터에서 iEKF 전 이터레이션 25 ms, 임베디드 보드에서 100 Hz이고, 인용 2,900회·별 5,275개가 그 설계 선택의 시장 가격이다. 자율주행 스택의 관점에서 이 글의 위치는 명확하다 — 인지(CenterPoint·BEVFusion)와 예측·계획이 아무리 좋아져도 “나는 지금 어디에 있는가”가 무너지면 전부 무효다. 카메라-관성(ORB-SLAM3), 라이다-관성(FAST-LIO), 맵 기반 매칭(Autoware)은 서로의 실패 조건이 다르기 때문에 병렬로 두는 것이 안전 설계다. 2020년에 공개된 C++ 패키지 하나가 2026년까지 갱신되는 주변 생태계(FAST-LIVO2 ⭐4,753, 2026-03 푸시)를 거느린 이유는 단순하다 — 논문을 읽는 것보다 저장소를 돌려보는 것이 빠르고, 이 저장소는 실제로 돌아간다.

원문: https://arxiv.org/abs/2010.08196(FAST-LIO, RA-L 2021) · https://arxiv.org/abs/2107.06829(FAST-LIO2, T-RO 2022) · 코드: https://github.com/hku-mars/FAST_LIO

목록으로 돌아가기