Preliminary results on globally asymptotically stable simultaneous localization and mapping in 3-D

This paper presents the design, analysis, performance evaluation, and preliminary experimental validation of a globally asymptotically stable (GAS) filter for simultaneous localization and mapping (SLAM) with application to unmanned aerial vehicles (UAVs). The SLAM problem is formulated in a sensor-based framework and modified in such a way that the system structure may be regarded as linear time-varying for observability purposes, from which a Kalman filter with GAS error dynamics follows naturally. The proposed solution includes the estimation of both body-fixed linear velocity and rate-gyro measurement biases. Both simulation results and preliminary experimental results, using an instrumented quadrotor equipped with a RGB-D camera, are included in the paper to illustrate the performance of the algorithm under realistic conditions.

[1]  Carlos Silvestre,et al.  Single range aided navigation and source localization: Observability and filter design , 2011, Syst. Control. Lett..

[2]  R. Brockett.  Finite Dimensional Linear Systems , 2015 .

[3]  B. Anderson.  Stability properties of Kalman-Bucy filters , 1971 .

[4]  Gamini Dissanayake,et al.  Convergence and Consistency Analysis for Extended Kalman Filter Based SLAM , 2007, IEEE Transactions on Robotics.

[5]  Luc Van Gool,et al.  Speeded-Up Robust Features (SURF) , 2008, Comput. Vis. Image Underst..

[6]  Carlos Silvestre,et al.  Sensor-based complementary globally asymptotically stable filters for attitude estimation , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[7]  Carlos Silvestre,et al.  Sensor-based simultaneous localization and mapping — Part II: Online inertial map and trajectory estimation , 2012, 2012 American Control Conference (ACC).

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

[9]  Carlos Silvestre,et al.  3-D inertial trajectory and map online estimation: Building on a GAS sensor-based SLAM filter , 2013, 2013 European Control Conference (ECC).

[10]  Carlos Silvestre,et al.  Sensor-based simultaneous localization and mapping — Part I: GAS robocentric filter , 2012, 2012 American Control Conference (ACC).

[11]  Nicu Sebe,et al.  Similarity Matching in Computer Vision and Multimedia , 2008, Comput. Vis. Image Underst..

[12]  Juan D. Tardós,et al.  Data association in stochastic mapping using the joint compatibility test , 2001, IEEE Trans. Robotics Autom..

[13]  James J. Little,et al.  Mobile Robot Localization and Mapping with Uncertainty using Scale-Invariant Visual Landmarks , 2002, Int. J. Robotics Res..

[14]  Avinash C. Kak,et al.  Vision for Mobile Robot Navigation: A Survey , 2002, IEEE Trans. Pattern Anal. Mach. Intell..

[15]  Wolfram Burgard,et al.  An evaluation of the RGB-D SLAM system , 2012, 2012 IEEE International Conference on Robotics and Automation.

[16]  José A. Castellanos,et al.  Robocentric map joining: Improving the consistency of EKF-SLAM , 2007, Robotics Auton. Syst..

[17]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

[18]  Hugh Durrant-Whyte,et al.  Simultaneous Localisation and Mapping ( SLAM ) : Part I The Essential Algorithms , 2006 .

[19]  Jeffrey K. Uhlmann,et al.  A counter example to the theory of simultaneous localization and map building , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).