Faster-LIO: Lightweight Tightly Coupled Lidar-Inertial odometry Using Parallel Sparse Incremental Voxels

被引:186
作者
Bai, Chunge [1 ,2 ]
Xiao, Tao [2 ]
Chen, Yajie [2 ]
Wang, Haoqian [1 ,2 ]
Zhang, Fang [2 ]
Gao, Xiang [2 ]
机构
[1] Tsinghua Univ, Dept Elect Informat & Engn, Beijing, Peoples R China
[2] Idriver Technol Co Ltd, Beijing, Peoples R China
关键词
Lidar-inertial odometry; SLAM; nearest neighbor;
D O I
10.1109/LRA.2022.3152830
中图分类号
TP24 [机器人技术];
学科分类号
080202 ; 1405 ;
摘要
This letter presents an incremental voxel-based lidar-inertial odometry (LIO) method for fast-tracking spinning and solid-state lidar scans. To achieve the high tracking speed, we neither use complicated tree-based structures to divide the spatial point cloud nor the strict k nearest neighbor (k-NN) queries to compute the point matching. Instead, we use the incremental voxels (iVox) as our point cloud spatial data structure, which is modified from the traditional voxels and supports incremental insertion and parallel approximated k-NN queries. We propose the linear iVox and PHC (Pseudo Hilbert Curve) iVox as two alternative underlying structures in our algorithm. The experiments show that the speed of iVox reaches 1000-2000 Hz per scan in solid-state lidars and over 200 Hz for 32 lines spinning lidars only with a modern CPU while still preserving the same level of accuracy.
引用
收藏
页码:4861 / 4868
页数:8
相关论文
共 47 条
[1]  
BECKMANN N, 1990, SIGMOD REC, V19, P322, DOI 10.1145/93605.98741
[2]  
Blanco JoseLuis., 2014, NANOFLANN C HEADER O
[3]   Off the Beaten Path: Let's Replace Term-Based Retrieval with k-NN Search [J].
Boytsov, Leonid ;
Novak, David ;
Malkov, Yury ;
Nyberg, Eric .
CIKM'16: PROCEEDINGS OF THE 2016 ACM CONFERENCE ON INFORMATION AND KNOWLEDGE MANAGEMENT, 2016, :1099-1108
[4]  
Cai Y., 2021, ARXIV210210808
[5]   University of Michigan North Campus long-term vision and lidar dataset [J].
Carlevaris-Bianco, Nicholas ;
Ushani, Arash K. ;
Eustice, Ryan M. .
INTERNATIONAL JOURNAL OF ROBOTICS RESEARCH, 2016, 35 (09) :1023-1035
[6]   Neighbor-finding based on space-filling curves [J].
Chen, HL ;
Chang, YI .
INFORMATION SYSTEMS, 2005, 30 (03) :205-226
[7]   All-nearest-neighbors finding based on the Hilbert curve [J].
Chen, Hue-Ling ;
Chang, Ye-In .
EXPERT SYSTEMS WITH APPLICATIONS, 2011, 38 (06) :7462-7475
[8]   Deep Global Registration [J].
Choy, Christopher ;
Dong, Wei ;
Koltun, Vladlen .
2020 IEEE/CVF CONFERENCE ON COMPUTER VISION AND PATTERN RECOGNITION (CVPR), 2020, :2511-2520
[9]  
Daun K, 2019, IEEE INT SYMP SAFE, P222, DOI [10.1109/SSRR.2019.8848964, 10.1109/ssrr.2019.8848964]
[10]   Fully Automatic Large-Scale Point Cloud Mapping for Low-Speed Self-driving Vehicles in Unstructured Environments [J].
Gao, Xiang ;
Wang, Qi ;
Gu, Hao ;
Zhang, Fang ;
Peng, Guoqi ;
Si, Yiwen ;
Li, Xiaofei .
2021 32ND IEEE INTELLIGENT VEHICLES SYMPOSIUM (IV), 2021, :881-888