Building a Robust Implementation of Bearing‐only Inertial SLAM for a UAV

This paper presents the on-going design and implementation of a robust inertial sensor based simultaneous localization and mapping (SLAM) algorithm for an unmanned aerial vehicle (UAV) using bearing-only observations. A single color vision camera is used to observe the terrain from which image points corresponding to features in the environment are extracted. The SLAM algorithm estimates the complete six degrees-of-freedom motion of the UAV along with the three-dimensional position of the features in the environment. An extended Kalman filter approach is used where a technique of delayed initialization is performed to initialize the three-dimensional position of features from bearing-only observations. Data association is achieved using a multihypothesis innovation gate based on the spatial uncertainty of each feature. Results are presented by running the algorithm off-line using inertial sensor and vision data collected during a flight test of a UAV. © 2007 Wiley Periodicals, Inc.

[1]  H. Sorenson,et al.  Nonlinear Bayesian estimation using Gaussian sum approximations , 1972 .

[2]  José A. Castellanos,et al.  Unscented SLAM for large-scale outdoor environments , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  D. Gebre-Egziabher,et al.  A low-cost GPS/inertial attitude heading reference system (AHRS) for general aviation applications , 1998, IEEE 1998 Position Location and Navigation Symposium (Cat. No.98CH36153).

[4]  Salah Sukkarieh,et al.  Active airborne localisation and exploration in unknown environments using inertial SLAM , 2006, 2006 IEEE Aerospace Conference.

[5]  Salah Sukkarieh,et al.  Real-Time Navigation, Guidance, and Control of a UAV Using Low-Cost Sensors , 2003, FSR.

[6]  Randall Smith,et al.  Estimating Uncertain Spatial Relationships in Robotics , 1987, Autonomous Robot Vehicles.

[7]  Juan D. Tardós,et al.  Hierarchical SLAM: real-time accurate mapping of large environments , 2005, IEEE Transactions on Robotics.

[8]  S. Sukkarieh,et al.  Autonomous airborne navigation in unknown terrain environments , 2004, IEEE Transactions on Aerospace and Electronic Systems.

[9]  Simon Lacroix,et al.  High resolution terrain mapping using low attitude aerial stereo imagery , 2003, Proceedings Ninth IEEE International Conference on Computer Vision.

[10]  E. Nebot,et al.  Bearing-only SLAM using colour-based feature tracking , 2002 .

[11]  R.D. Braun,et al.  The Mars airplane: a credible science platform , 2004, 2004 IEEE Aerospace Conference Proceedings (IEEE Cat. No.04TH8720).

[12]  Stefan B. Williams,et al.  Towards terrain-aided navigation for underwater robotics , 2001, Adv. Robotics.

[13]  Hugh F. Durrant-Whyte,et al.  "OXNAV": reliable autonomous navigation , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[14]  Eric Nettleton,et al.  Decentralised Architectures for tracking and navigation with multiple flight vehicles , 2003 .

[15]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[16]  Salah Sukkarieh,et al.  Airborne simultaneous localisation and map building , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[17]  Stefan B. Williams,et al.  Map Management for Efficient Simultaneous Localization and Mapping (SLAM) , 2002, Auton. Robots.

[18]  G LoweDavid,et al.  Distinctive Image Features from Scale-Invariant Keypoints , 2004 .

[19]  Andrew W. Fitzgibbon,et al.  Bundle Adjustment - A Modern Synthesis , 1999, Workshop on Vision Algorithms.

[20]  Salah Sukkarieh,et al.  The Development of a Real-Time Modular Architecture for the Control of UAV Teams , 2005, FSR.

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

[22]  Michel Devy,et al.  Undelayed initialization in bearing only SLAM , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Tim Bailey.  Constrained initialisation for bearing-only SLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[24]  Jean-Yves Bouguet,et al.  Camera calibration toolbox for matlab , 2001 .

[25]  Javier Civera,et al.  Unified Inverse Depth Parametrization for Monocular SLAM , 2006, Robotics: Science and Systems.

[26]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[27]  N. Gordon,et al.  Novel approach to nonlinear/non-Gaussian Bayesian state estimation , 1993 .

[28]  Gamini Dissanayake,et al.  An efficient multiple hypothesis filter for bearing-only SLAM , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[29]  Martial Hebert,et al.  Experimental Comparison of Techniques for Localization and Mapping Using a Bearing-Only Sensor , 2000, ISER.

[30]  Eduardo Mario Nebot,et al.  Optimization of the simultaneous localization and map-building algorithm for real-time implementation , 2001, IEEE Trans. Robotics Autom..

[31]  Mark S. Nixon,et al.  Feature Extraction and Image Processing , 2002 .

[32]  Andrew J. Davison,et al.  Real-time simultaneous localisation and mapping with a single camera , 2003, Proceedings Ninth IEEE International Conference on Computer Vision.