SLAM within indoor loops by using incremental scan registration

This paper presents an efficient solution to fulfill the Simultaneous Localization and Mapping (SLAM) in indoor environment where there are monotonous areas and large loops. The proposed approach works on Split Sparse Points Maps (SSPM) and is mainly based on incremental scan registration by using the Point-to-Line Iterative Closest Point (PLICP) algorithm. To enhance the robustness of scan registration in monotonous environment, an Incident Angle Fused Metric (IAFM) is introduced during the association procedure of scan registration. Furthermore, with the manner of sub maps joining, a trajectory bending based loop closure approach is applied, which can efficiently eliminate the map inconsistence that is generated from error accumulation of scans registration. Experiment is conducted in real environment and the results obtained from different methods are compared and discussed, which verifies the validation of the proposed methods.

[1]  Wolfram Burgard,et al.  A Tutorial on Graph-Based SLAM , 2010, IEEE Intelligent Transportation Systems Magazine.

[2]  Andrea Censi,et al.  An ICP variant using a point-to-line metric , 2008, 2008 IEEE International Conference on Robotics and Automation.

[3]  Sven Behnke,et al.  Sancta simplicitas - on the efficiency and achievable results of SLAM using ICP-based incremental registration , 2010, 2010 IEEE International Conference on Robotics and Automation.

[4]  Florent Lamiraux,et al.  Metric-Based Scan Matching Algorithms for Mobile Robot Displacement Estimation , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[5]  Yukinori Kobayashi,et al.  Indoor Slope and Edge Detection by Using Two-Dimensional EKF-SLAM with Orthogonal Assumption , 2015 .

[6]  Paul Newman,et al.  SLAM-Loop Closing with Visually Salient Features , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[7]  Hugh Durrant-Whyte,et al.  Simultaneous localization and mapping (SLAM): part II , 2006 .

[8]  Evangelos E. Milios,et al.  Robot Pose Estimation in Unknown Environments by Matching 2D Range Scans , 1994, 1994 Proceedings of IEEE Conference on Computer Vision and Pattern Recognition.

[9]  Marc Pollefeys,et al.  Robust pose-graph loop-closures with expectation-maximization , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Wolfram Burgard,et al.  Improving Grid-based SLAM with Rao-Blackwellized Particle Filters by Adaptive Proposals and Selective Resampling , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

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

[12]  Klamer Schutte,et al.  Efficient trajectory bending with applications to loop closure , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Roland Siegwart,et al.  EKF-based 3D SLAM for structured environment reconstruction , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Tomás Svoboda,et al.  Robust Data Fusion of Multimodal Sensory Information for Mobile Robots , 2015, J. Field Robotics.