BoW3D: Bag of Words for Real-Time Loop Closing in 3D LiDAR SLAM

• Published in: IEEE robotics and automation letters Vol. 8; no. 5; pp. 2828 - 2835
• Main Authors: Cui, Yunge, Chen, Xieyuanli, Zhang, Yinlong, Dong, Jiahua, Wu, Qingxiao, Zhu, Feng
• Format: Journal Article
• Language: English
• Published: Piscataway IEEE 01.05.2023; The Institute of Electrical and Electronics Engineers, Inc. (IEEE)
• Subjects: Algorithms; Bag of words; Feature extraction; Laser radar; Lidar; LinK3D feature; loop correction; Microprocessors; Performance evaluation; place recognition; Point cloud compression; Real time; Real-time systems; Simultaneous localization and mapping; Three-dimensional displays; Visual fields; Visualization
• ISSN: 2377-3766; 2377-3766
• DOI: 10.1109/LRA.2022.3221336

Loop closing is a fundamental part of simultaneous localization and mapping (SLAM) for autonomous mobile systems. In the field of visual SLAM, bag of words (BoW) has achieved great success in loop closure. The BoW features for loop searching can also be used in the subsequent 6-DoF loop correction. However, for 3D LiDAR SLAM, the state-of-the-art methods may fail to effectively recognize the loop in real time, and usually cannot correct the full 6-DoF loop pose. To address this limitation, we present a novel B ag o f W ords for real-time loop closing in 3D LiDAR SLAM, called BoW3D. Our method not only efficiently recognizes the revisited loop places, but also corrects the full 6-DoF loop pose in real time. BoW3D builds the bag of words based on the 3D LiDAR feature LinK3D, which is efficient, pose-invariant and can be used for accurate point-to-point matching. We furthermore embed our proposed method into 3D LiDAR odometry system to evaluate loop closing performance. We test our method on public dataset, and compare it against other state-of-the-art algorithms. BoW3D shows better performance in terms of <inline-formula><tex-math notation="LaTeX">F_{1}</tex-math></inline-formula> max and extended precision scores on most scenes. It is noticeable that BoW3D takes an average of 48 ms to recognize and correct the loops on KITTI 00 (includes 4K+ 64-ray LiDAR scans), when executed on a notebook with an Intel Core i7 @2.2 GHz processor.