Rigid Point Set Registration Based on Cubature Kalman Filter and Its Application in Intelligent Vehicles

Point set registration is a key problem in intelligent vehicle localization and mapping. This paper presents a rigid point set registration algorithm based on the cubature Kalman filter (CKF). First, the point set registration problem is cast into the state space model assuming that the correspondence between these two point sets is previously unknown. Then, CKF is used to solve this nonlinear filtering problem. At every iterative step, all the points in the moving point set will be considered, and the corresponding points in the model point set will be updated accordingly. In the time update, the scale of the free space that can be explored is significant for this registration algorithm. Herein, continuous simulated annealing (CSA) is adopted to gradually optimize the covariance of the model noise to speed up convergence. Tests on public data sets show that the CKF-based point set registration algorithm is robust to outliers, noise, and initialization misalignment. Then, the application of this algorithm on intelligent vehicles and intelligent transportation systems is demonstrated through mapping and localization experiments. The precision and robustness are both validated compared with the traditional ICP, NDT, and CPD based point set registrations in the localization experiments. Thus, the contributions of this paper are threefold. First, a CKF scheme is utilized in the point set registration problem. Second, CSA serves as the local optimizer to speed up the convergence process and make it more accurate. Third, this filtering-based method is adopted in intelligent vehicles and SLAM applications.

[1]  Ioannis A. Kakadiaris,et al.  3D Facial Landmark Detection under Large Yaw and Expression Variations , 2013, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[2]  C. Hwang.  Simulated annealing: Theory and applications , 1988, Acta Applicandae Mathematicae - An International Survey Journal on Applying Mathematics and Mathematical Applications.

[3]  Andrew W. Fitzgibbon.  Robust registration of 2D and 3D point sets , 2003, Image Vis. Comput..

[4]  Achim J. Lilienthal,et al.  Point set registration through minimization of the L2 distance between 3D-NDT models , 2012, 2012 IEEE International Conference on Robotics and Automation.

[5]  Jiaolong Yang,et al.  Go-ICP: A Globally Optimal Solution to 3D ICP Point-Set Registration , 2016, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[6]  Florent Lamiraux,et al.  Metric-based iterative closest point scan matching for sensor displacement estimation , 2006, IEEE Transactions on Robotics.

[7]  Baba C. Vemuri,et al.  Robust Point Set Registration Using Gaussian Mixture Models , 2011, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[8]  Purang Abolmaesumi,et al.  Point-Based Rigid-Body Registration Using an Unscented Kalman Filter , 2007, IEEE Transactions on Medical Imaging.

[9]  Gang Wang,et al.  Fuzzy Correspondences and Kernel Density Estimation for Contaminated Point Set Registration , 2015, 2015 IEEE International Conference on Systems, Man, and Cybernetics.

[10]  Paul Newman,et al.  Road vehicle localization with 2D push-broom LIDAR and 3D priors , 2012, 2012 IEEE International Conference on Robotics and Automation.

[11]  Suyash P. Awate,et al.  Point Set Registration Using Havrda–Charvat–Tsallis Entropy Measures , 2011, IEEE Transactions on Medical Imaging.

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

[13]  Paul Newman,et al.  Continuous vehicle localisation using sparse 3D sensing, kernelised rényi distance and fast Gauss transforms , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Xavier Pennec,et al.  Multi-scale EM-ICP: A Fast and Robust Approach for Surface Registration , 2002, ECCV.

[15]  Wenbing Tao,et al.  Robust Point Sets Matching by Fusing Feature and Spatial Information Using Nonuniform Gaussian Mixture Models , 2015, IEEE Transactions on Image Processing.

[16]  Steven G. Louie,et al.  A Monte carlo simulated annealing approach to optimization over continuous variables , 1984 .

[17]  Peng Song,et al.  3D Object Recognition in Cluttered Scenes With Robust Shape Description and Correspondence Selection , 2017, IEEE Access.

[18]  Ming Yang,et al.  Cubature Kalman Filter based point set registration for SLAM , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

[19]  Paul Newman,et al.  Laser-only road-vehicle localization with dual 2D push-broom LIDARS and 3D priors , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Wenbing Tao,et al.  Asymmetrical Gauss Mixture Models for Point Sets Matching , 2014, 2014 IEEE Conference on Computer Vision and Pattern Recognition.

[21]  Patricio A. Vela,et al.  A Stochastic Approach to Diffeomorphic Point Set Registration with Landmark Constraints , 2016, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[22]  Andriy Myronenko,et al.  Point Set Registration: Coherent Point Drift , 2009, IEEE Transactions on Pattern Analysis and Machine Intelligence.

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

[24]  Allen R. Tannenbaum,et al.  Point Set Registration via Particle Filtering and Stochastic Dynamics , 2010, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[25]  S. Haykin,et al.  Cubature Kalman Filters , 2009, IEEE Transactions on Automatic Control.

[26]  H. Chui,et al.  A feature registration framework using mixture models , 2000, Proceedings IEEE Workshop on Mathematical Methods in Biomedical Image Analysis. MMBIA-2000 (Cat. No.PR00737).

[27]  Q. M. Jonathan Wu,et al.  Multiple Kernel Point Set Registration , 2016, IEEE Transactions on Medical Imaging.