Testing the Accuracy of the Modified ICP Algorithm with Multimodal Weighting Factors

SLAM technology is increasingly used to self-locate mobile robots in an unknown environment. One of the methods used in this technology is called scan matching. Increasing evidence is placed on the accuracy and speed of the methods used in terms of navigating mobile robots. The aim of this article is to present a modification to the standard method of Iterative Closest Point (ICP) environment scan matching using the authors’ three original weighting factors based on the error modeling. The presented modification was supported by a simulation study whose aim was not exclusively to check the effect of the factors but also to examine the effect of the number of points in scans on the correct and accurate development of the rotation matrix and the translation vector. The study demonstrated both an increase in the accuracy of ICP results following the implementation of the proposed modification and a noticeable increase in accuracy with an increase in the mapping device’s angular resolution. The proposed method has a positive impact on reducing number of iteration and computing time. The research results have shown to be promising and will be extended to 3D space in the future.

[1]  Eduardo Mario Nebot,et al.  Scan-SLAM: Combining EKF-SLAM and Scan Correlation , 2005, FSR.

[2]  Albert-Jan Baerveldt,et al.  Robot localization based on scan-matching - estimating the covariance matrix for the IDC algorithm , 2003, Robotics Auton. Syst..

[3]  Silvere Bonnabel,et al.  Towards realistic covariance estimation of ICP-based Kinect V1 scan matching: The 1D case , 2017, 2017 American Control Conference (ACC).

[4]  Micha Sharir,et al.  On the ICP algorithm , 2006, SCG '06.

[5]  Ji Zhang,et al.  LOAM: Lidar Odometry and Mapping in Real-time , 2014, Robotics: Science and Systems.

[6]  Seongmin Baek,et al.  Human Pose Estimation Using Articulated ICP , 2019, Proceedings of the 2019 2nd International Conference on Control and Robot Technology.

[7]  Liu Jilin,et al.  Scan matching based on CLS relationships , 2003, IEEE International Conference on Robotics, Intelligent Systems and Signal Processing, 2003. Proceedings. 2003.

[8]  Bin Liang,et al.  An Iterative Closest Points Algorithm for Registration of 3D Laser Scanner Point Clouds with Geometric Features , 2017, Sensors.

[9]  Shaoyi Du,et al.  Robust iterative closest point algorithm based on global reference point for rotation invariant registration , 2017, PloS one.

[10]  Dirk Kraft,et al.  Prediction of ICP pose uncertainties using Monte Carlo simulation with synthetic depth images , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[11]  Martin Brossard,et al.  A New Approach to 3D ICP Covariance Estimation , 2020, IEEE Robotics and Automation Letters.

[12]  Alfredo Cuzzocrea,et al.  An effective and efficient hybrid scan matching algorithm for mobile object applications , 2017, SAC.

[13]  Bin Liang,et al.  A Fast Weighted Registration Method of 3D Point Cloud Based on Curvature Feature , 2018, ICMIP 2018.

[14]  Jingchuan Wang,et al.  MIM_SLAM: A Multi-Level ICP Matching Method for Mobile Robot in Large-Scale and Sparse Scenes , 2018 .

[15]  Sebastian Thrun,et al.  Simultaneous localization and mapping with active stereo vision , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[16]  Marc Levoy,et al.  Efficient variants of the ICP algorithm , 2001, Proceedings Third International Conference on 3-D Digital Imaging and Modeling.

[17]  Marc Rioux,et al.  Three-dimensional registration using range and intensity information , 1994, Other Conferences.

[18]  Johann Laconte,et al.  Lidar Measurement Bias Estimation via Return Waveform Modelling in a Context of 3D Mapping , 2018, 2019 International Conference on Robotics and Automation (ICRA).

[19]  Krzysztof Naus,et al.  Use of a Weighted ICP Algorithm to Precisely Determine USV Movement Parameters , 2019 .

[20]  Huosheng Hu,et al.  LIDAR Point Cloud Registration for Sensing and Reconstruction of Unstructured Terrain , 2018 .

[21]  Paul Checchin,et al.  CICP: Cluster Iterative Closest Point for sparse-dense point cloud registration , 2018, Robotics Auton. Syst..

[22]  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.

[23]  Guodong Liu,et al.  FFT-Based Scan-Matching for SLAM Applications with Low-Cost Laser Range Finders , 2018 .

[24]  R. Siegwart,et al.  Noise characterization of depth sensors for surface inspections , 2012, 2012 2nd International Conference on Applied Robotics for the Power Industry (CARPI).

[25]  Wolfram Burgard,et al.  On the position accuracy of mobile robot localization based on particle filters combined with scan matching , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  Petr Musílek,et al.  Novel Point-to-Point Scan Matching Algorithm Based on Cross-Correlation , 2016, Mob. Inf. Syst..

[27]  Mariusz Specht,et al.  Optimisation of the Position of Navigational Aids for the Purposes of SLAM technology for Accuracy of Vessel Positioning , 2019, Journal of Navigation.

[28]  Thomas Röfer,et al.  Using histogram correlation to create consistent laser scan maps , 2002, IROS.

[29]  Rong Wang,et al.  WA-ICP algorithm for tackling ambiguous correspondence , 2015, 2015 3rd IAPR Asian Conference on Pattern Recognition (ACPR).

[30]  Jean-Emmanuel Deschaud,et al.  IMLS-SLAM: Scan-to-Model Matching Based on 3D Data , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[31]  Naus Krzysztof,et al.  The Positioning Accuracy of BAUV Using Fusion of Data from USBL System and Movement Parameters Measurements , 2016, Sensors.

[32]  Esmeide Leal,et al.  Non-Local SVD Denoising of MRI Based on Sparse Representations , 2020, Sensors.

[33]  Stergios I. Roumeliotis,et al.  Weighted range sensor matching algorithms for mobile robot displacement estimation , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).