Enhanced Laser-Scan Matching with Online Error Estimation for Highway and Tunnel Driving

Matthew McDermott and Jason Rife

Peer Reviewed

Abstract: Lidar data can be used to generate point clouds for the navigation of autonomous vehicles or mobile robotics platforms. Scan matching, the process of estimating the rigid transformation that best aligns two-point clouds, is the basis for lidar odometry, a form of dead reckoning. Lidar odometry is particularly useful when absolute sensors, like GPS, are not available. Here we propose the Iterative Closest Ellipsoidal Transform (ICET), a scan matching algorithm which provides two novel improvements over the current state-of-the-art Normal Distributions Transform (NDT). Like NDT, ICET decomposes lidar data into voxels and fits a Gaussian distribution to the points within each voxel. The first innovation of ICET reduces geometric ambiguity along large flat surfaces by suppressing the solution along those directions. The second innovation of ICET is to infer the output error covariance associated with the position and orientation transformation between successive point clouds; the error covariance is particularly useful when ICET is incorporated into a state-estimation routine such as an extended Kalman filter. We constructed a simulation to compare the performance of ICET and NDT in 2D space both with and without geometric ambiguity and found that ICET produces superior estimates while accurately predicting solution accuracy.
Published in: Proceedings of the 2022 International Technical Meeting of The Institute of Navigation
January 25 - 27, 2022
Hyatt Regency Long Beach
Long Beach, California
Pages: 643 - 654
Cite this article: McDermott, Matthew, Rife, Jason, "Enhanced Laser-Scan Matching with Online Error Estimation for Highway and Tunnel Driving," Proceedings of the 2022 International Technical Meeting of The Institute of Navigation, Long Beach, California, January 2022, pp. 643-654. https://doi.org/10.33012/2022.18249
Full Paper: ION Members/Non-Members: 1 Download Credit
Sign In