Abstract：Considering the enormous moving objects, serious occlusions, and low precision of GPS (global positioning system) in urban dynamic environment, a fast and robust registration method which can adapt to different initial position errors without detecting dynamic objects is proposed. Firstly, the region growing method is used for object segmentation of obstacle point cloud without ground data; and by setting constraint conditions, segmentation result is optimized to generate object gravity centers of one point cloud. Then, an algorithm framework with multi-nested loop of RANSAC (random sample consensus) in which registration results is updated iteratively is put forward to achieve rough registration of centroid sets and remove outliers. ICP (iterative closest point) is finally used for precise registration. The contrast experiments with the traditional RANSAC algorithm show that the proposed method can achieve accurate and reliable point cloud registration in complex dynamic scenes with large initial position errors, and the registration success rate and registration speed are significantly higher than those of traditional methods.
 Levinson J S. Automatic laser calibration, mapping, and localization for autonomous vehicles[M]. Palo Alto, USA:Stanford University, 2011.
 Wolcott R W, Eustice R M. Fast LIDAR localization using multiresolution Gaussian mixture maps[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2015:2814-2821.
 Zhang J, Singh S. Low-drift and real-time lidar odometry and mapping[J]. Autonomous Robots, 2017, 41(2):401-416.
 Xiao J, Adler B, Zhang H. 3D point cloud registration based on planar surfaces[C]//IEEE Conference on Multisensor Fusion and Integration for Intelligent Systems. Piscataway, USA:IEEE, 2012:40-45.
 Cadena C, Carlone L, Carrillo H, et al. Past, present, and future of simultaneous localization and mapping:Towards the robust-perception age[J]. IEEE Transactions on Robotics, 2016, 32(6):1309-1332.
 Segal A, Haehnel D, Thrun S. Generalized-ICP[C]//Robotics:Science and Systems V. Cambridge, USA:MIT Press, 2009:26-27.
 Servos J, Waslander S L. Multi channel generalized-ICP[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2014:3644-3649.
 Chum O, Matas J. Matching with PROSAC-progressive sample consensus[C]//IEEE Computer Society Conference on Computer Vision and Pattern Recognition. Piscataway, USA:IEEE, 2005:220-226.
 Chum O, Matas J, Kittler J. Locally optimized RANSAC[C]//Joint Pattern Recognition Symposium. Berlin, Germany:Springer Verlag, 2003:236-243.
 Sattler T, Leibe B, Kobbelt L. SCRAMSAC:Improving RANSAC's efficiency with a spatial consistency filter[C]//IEEE Computer Society Conference on Computer Vision. Piscataway, USA:IEEE, 2009:2090-2097.
 Yang J, Cao Z, Zhang Q. A fast and robust local descriptor for 3D point cloud registration[J]. Information Sciences, 2016, 346(C):163-179.
 Ni K, Jin H, Dellaert F. GroupSAC:Efficient consensus in the presence of groupings[C]//IEEE Computer Society Conference on Computer Vision. Piscataway, USA:IEEE, 2009:2193-2200.
 Pankaj D S, Nidamanuri R R. A robust estimation technique for 3D point cloud registration[J]. Image Analysis & Stereology, 2016, 35(1):15-28.
 Aiger D, Mitra N J, Cohenor D. 4-points congruent sets for robust pairwise surface registration[J]. ACM Transactions on Graphics, 2011, 27(3):1-10.
 Mellado N, Aiger D, Mitra N J. Super 4PCS fast global pointcloud registration via smart indexing[J]. Computer Graphics Forum, 2015, 33(5):205-215.
 Schlichting A, Brenner C. Vehicle localization by LIDAR point correlation improved by change detection[J]. ISPRS-International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences, 2016, XLI-B1:703-710.
 Burgard W, Brock O, Stachniss C. Simultaneous localisation and mapping in dynamic environments (SLAMIDE) with reversible data association[C]//Robotics:Science and Systems Ⅲ. Cambridge, USA:MIT Press, 2007:105-112.
 Wang C C, Thorpe C, Thrun S, et al. Simultaneous localization, mapping and moving object tracking[J]. International Journal of Robotics Research, 2007, 26(9):889-916.
 Lu Z, Hu Z, Uchimura K. SLAM estimation in dynamic outdoor environments:A review[C]//International Conference on Intelligent Robotics and Applications. Berlin, Germany:Springer Verlag, 2009:255-267.
 Yang S W, Wang C C. Multiple-model RANSAC for ego-motion estimation in highly dynamic environments[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2009:3531-3538.
 Fischler M A, Bolles R C. Random sample consensus:A paradigm for model fitting with applications to image analysis and automated cartography[J]. Communications of the ACM, 1981, 24(6):381-395.