AGPC-SLAM: Absolute Ground Plane Constrained 3D LiDAR SLAM

Research output: Journal article publicationJournal articleAcademic researchpeer-review


3D LiDAR-based simultaneous localization and mapping (SLAM) is a well-recognized solution for mapping and localization applications. However, the typical 3D LiDAR sensor (e.g. Velodyne HDL-32E) only provides a very limited field of view vertically. As a result, the vertical accuracy of pose estimation is suffered. This paper aims to alleviate this problem by detecting the absolute ground plane to constrain the vertical pose estimation. Different from the conventional relative plane constraint, this paper employs the absolute plane distance to refine the position in the z-axis and the norm vector of the ground plane to constrain the attitude drift. Finally, relative positioning from LiDAR odometry, constraint from ground plane detection, and loop closure are integrated under a proposed factor graph-based 3D LiDAR SLAM framework (AGPC-SLAM). The effectiveness is verified using several datasets collected in scenes of Hong Kong.
Original languageEnglish
Number of pages11
JournalNavigation, Journal of the Institute of Navigation
Issue number3
Publication statusAccepted/In press - Sep 2022

Cite this