Indirect Visual Simultaneous Localization and Mapping Based on Linear Models

This paper proposes an indirect visual simultaneous localization and mapping (V-SLAM) for large-scale outdoor environments based on linear models. With the scale-invariant feature transform (SIFT) algorithm, a design combining key-frame insertion and map management is proposed to avoid redundant computation and unreliable landmarks. Then, an iterative linear equation is employed to update landmarks. With the supplement of reliable map data, absolute camera poses can be obtained using a simple linear equation based on a linearity index. In addition, a linear model helps the system to detect candidates of looped frames and discard invalid loops by means of an outlier weight function. If a loop is detected, an improved trajectory bending algorithm is introduced to optimize the estimations of poses and landmarks. To evaluate the effectiveness of the proposed approach, extensive experiments are conducted using various sequences from a well-known public dataset. Experimental results show that the proposed V-SLAM outperforms other existing methods in terms of various metrics.

[1]  Hong Zhang,et al.  Online Loop-Closure Detection via Dynamic Sparse Representation , 2015, FSR.

[2]  Olivier Stasse,et al.  MonoSLAM: Real-Time Single Camera SLAM , 2007, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[3]  H. Jin Kim,et al.  Real-time 6-DOF monocular visual SLAM in a large-scale environment , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[4]  Daniel Cremers,et al.  LSD-SLAM: Large-Scale Direct Monocular SLAM , 2014, ECCV.

[5]  Hauke Strasdat,et al.  Visual SLAM: Why filter? , 2012, Image Vis. Comput..

[6]  John J. Leonard,et al.  An Online Sparsity-Cognizant Loop-Closure Algorithm for Visual Navigation , 2014, Robotics: Science and Systems.

[7]  G. Klein,et al.  Parallel Tracking and Mapping for Small AR Workspaces , 2007, 2007 6th IEEE and ACM International Symposium on Mixed and Augmented Reality.

[8]  Wolfram Burgard,et al.  G2o: A general framework for graph optimization , 2011, 2011 IEEE International Conference on Robotics and Automation.

[9]  Yi Li,et al.  Parallelizing image feature extraction algorithms on multi-core platforms , 2016, J. Parallel Distributed Comput..

[10]  Wolfram Burgard,et al.  A benchmark for the evaluation of RGB-D SLAM systems , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Juan D. Tardós,et al.  ORB-SLAM2: An Open-Source SLAM System for Monocular, Stereo, and RGB-D Cameras , 2016, IEEE Transactions on Robotics.

[12]  Edwin Olson,et al.  Inference on networks of mixtures for robust robot mapping , 2013, Int. J. Robotics Res..

[13]  Hujun Bao,et al.  Keyframe-based real-time camera tracking , 2009, 2009 IEEE 12th International Conference on Computer Vision.

[14]  Chiang-Ju Chien,et al.  Hardware-Software Co-Design of an Image Feature Extraction and Matching Algorithm , 2019, 2019 2nd International Conference on Intelligent Autonomous Systems (ICoIAS).

[15]  Brett Browning,et al.  COP-SLAM: Closed-Form Online Pose-Chain Optimization for Visual SLAM , 2015, IEEE Transactions on Robotics.

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

[17]  Tom Drummond,et al.  Machine Learning for High-Speed Corner Detection , 2006, ECCV.

[18]  Dorian Gálvez-López,et al.  Bags of Binary Words for Fast Place Recognition in Image Sequences , 2012, IEEE Transactions on Robotics.

[19]  Tatsuya Suzuki,et al.  Measurement of vehicle motion and orientation using optical flow , 1999, Proceedings 199 IEEE/IEEJ/JSAI International Conference on Intelligent Transportation Systems (Cat. No.99TH8383).

[20]  Simon Lacroix,et al.  Location graphs for visual place recognition , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[21]  Niko Sünderhauf,et al.  Switchable constraints vs. max-mixture models vs. RRR - A comparison of three approaches to robust pose graph SLAM , 2013, 2013 IEEE International Conference on Robotics and Automation.

[22]  Hauke Strasdat,et al.  Scale Drift-Aware Large Scale Monocular SLAM , 2010, Robotics: Science and Systems.

[23]  José Luis Blanco Claraco,et al.  Simultaneous Localization and Mapping for Mobile Robots: Introduction and Methods , 2012 .

[24]  Paul H. J. Kelly,et al.  SLAM++: Simultaneous Localisation and Mapping at the Level of Objects , 2013, 2013 IEEE Conference on Computer Vision and Pattern Recognition.

[25]  Stefan Leutenegger,et al.  ElasticFusion: Dense SLAM Without A Pose Graph , 2015, Robotics: Science and Systems.

[26]  Shadrokh Samavi,et al.  Geometrical Analysis of Localization Error in Stereo Vision Systems , 2013, IEEE Sensors Journal.

[27]  Yasir Latif,et al.  Realizing, reversing, recovering: Incremental robust loop closing over time using the iRRR algorithm , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Andreas Geiger,et al.  Vision meets robotics: The KITTI dataset , 2013, Int. J. Robotics Res..

[29]  Andreas Geiger,et al.  Are we ready for autonomous driving? The KITTI vision benchmark suite , 2012, 2012 IEEE Conference on Computer Vision and Pattern Recognition.

[30]  J. M. M. Montiel,et al.  ORB-SLAM: A Versatile and Accurate Monocular SLAM System , 2015, IEEE Transactions on Robotics.

[31]  Christopher Hunt,et al.  Notes on the OpenSURF Library , 2009 .

[32]  Tomohiro Shibata,et al.  High performance loop closure detection using bag of word pairs , 2016, Robotics Auton. Syst..

[33]  Joaquim Salvi,et al.  Visual SLAM for 3D large-scale seabed acquisition employing underwater vehicles , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[34]  Niko Sünderhauf,et al.  Switchable constraints for robust pose graph SLAM , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[35]  Kurt Konolige,et al.  Double window optimisation for constant time visual SLAM , 2011, 2011 International Conference on Computer Vision.

[36]  Frank Dellaert,et al.  Selecting good measurements via ℓ1 relaxation: A convex approach for robust estimation over graphs , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[37]  Mohamed Abouzahir,et al.  Embedding SLAM algorithms: Has it come of age? , 2018, Robotics Auton. Syst..

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