A Fast RANSAC-Based Registration Algorithm for Accurate Localization in Unknown Environments using LIDAR Measurements

The problem of accurate localization using only measurements from a LIDAR sensor is analyzed in this paper. The sensor is rigidly fixed on a generic moving platform, which moves on a plane. Practical on-line applications of localization algorithms impose constraints on the execution time, problem that is addressed in this paper and compared with other existing solutions. Due to the nature of the sensor adopted, the localization algorithm is based on a fast and accurate registration algorithm, which is able to deal with noisy measurements, outliers and dynamic environments. The proposed solution relies on the RANSAC algorithm in combination with a Huber kernel in order to cope with typical nuisances in LIDAR measurements. The robust registration is successively used in combination with an extended Kalman filter to track the trajectory of the LIDAR over time, hence to solve the localization problem. Simulations and experimental results are reported to show the feasibility of the proposed approach.

[1]  Peter J. Huber,et al.  Robust Statistics , 2005, Wiley Series in Probability and Statistics.

[2]  Yuanxi Yang,et al.  Robust Kalman filter for rank deficient observation models , 1998 .

[3]  Yi-Ping Hung,et al.  RANSAC-Based DARCES: A New Approach to Fast Automatic Registration of Partially Overlapping Range Images , 1999, IEEE Trans. Pattern Anal. Mach. Intell..

[4]  Robert C. Bolles,et al.  Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography , 1981, CACM.

[5]  Gregory D. Hager,et al.  Efficient particle filtering using RANSAC with application to 3D face tracking , 2006, Image and Vision Computing.

[6]  Carl-Fredrik Westin,et al.  Robust Generalized Total Least Squares Iterative Closest Point Registration , 2004, MICCAI.

[7]  Juan D. Tardós,et al.  Data association in stochastic mapping using the joint compatibility test , 2001, IEEE Trans. Robotics Autom..

[8]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[9]  Stefano Soatto,et al.  KALMANSAC: robust filtering by consensus , 2005, Tenth IEEE International Conference on Computer Vision (ICCV'05) Volume 1.

[10]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[11]  Andrew Zisserman,et al.  MLESAC: A New Robust Estimator with Application to Estimating Image Geometry , 2000, Comput. Vis. Image Underst..

[12]  Stergios I. Roumeliotis,et al.  Bayesian estimation and Kalman filtering: a unified framework for mobile robot localization , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[13]  Sebastian Thrun,et al.  FastSLAM 2.0: An Improved Particle Filtering Algorithm for Simultaneous Localization and Mapping that Provably Converges , 2003, IJCAI.

[14]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[15]  Wolfram Burgard,et al.  A real-time expectation-maximization algorithm for acquiring multiplanar maps of indoor environments with mobile robots , 2004, IEEE Transactions on Robotics and Automation.

[16]  Charles E. Thorpe,et al.  A hierarchical object based representation for simultaneous localization and mapping , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[17]  Andrew W. Fitzgibbon,et al.  Robust Registration of 2D and 3D Point Sets , 2003, BMVC.

[18]  Nahum Shimkin,et al.  Nonlinear Control Systems , 2008 .

[19]  Paul Newman,et al.  Using laser range data for 3D SLAM in outdoor environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[20]  Gérard G. Medioni,et al.  Object modeling by registration of multiple range images , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[21]  B. Schölkopf,et al.  Non-rigid point set registration: Coherent Point Drift , 2007 .

[22]  Takeo Kanade,et al.  A Correlation-Based Approach to Robust Point Set Registration , 2004, ECCV.

[23]  Hugh F. Durrant-Whyte,et al.  Combining Object Recognition and SLAM for Extended Map Representations , 2006, ISER.

[24]  Miguel Á. Carreira-Perpiñán,et al.  Non-rigid point set registration: Coherent Point Drift , 2006, NIPS.

[25]  B. Ripley,et al.  Robust Statistics , 2018, Wiley Series in Probability and Statistics.