A Novel Fusion Scheme for Vision Aided Inertial Navigation of Aerial Vehicles

Vision-aided inertial navigation is an important and practical mode of integrated navigation for aerial vehicles. In this paper, a novel fusion scheme is proposed and developed by using the information from inertial navigation system (INS) and vision matching subsystem. This scheme is different from the conventional Kalman filter (CKF); CKF treats these two information sources equally even though vision-aided navigation is linked to uncertainty and inaccuracy. Eventually, by concentrating on reliability of vision matching, the fusion scheme of integrated navigation is upgraded. Not only matching positions are used, but also their reliable extents are considered. Moreover, a fusion algorithm is designed and proved to be the optimal as it minimizes the variance in terms of mean square error estimation. Simulations are carried out to validate the effectiveness of this novel navigation fusion scheme. Results show the new fusion scheme outperforms CKF and adaptive Kalman filter (AKF) in vision/INS estimation under given scenarios and specifications.

[1]  Roland Siegwart,et al.  Vision based MAV navigation in unknown and unstructured environments , 2010, 2010 IEEE International Conference on Robotics and Automation.

[2]  Stergios I. Roumeliotis,et al.  A Multi-State Constraint Kalman Filter for Vision-aided Inertial Navigation , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[3]  Timothy W. McLain,et al.  Autonomous Vehicle Technologies for Small Fixed Wing UAVs , 2003 .

[4]  Clark N. Taylor,et al.  Comparison of Two Image and Inertial Sensor Fusion Techniques for Navigation in Unmapped Environments , 2011, IEEE Transactions on Aerospace and Electronic Systems.

[5]  Tom Drummond,et al.  Faster and Better: A Machine Learning Approach to Corner Detection , 2008, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[6]  Jinling Wang,et al.  INTEGRATION OF GPS / INS / VISION SENSORS TO NAVIGATE UNMANNED AERIAL VEHICLES , 2008 .

[7]  Jinling Wang,et al.  Evaluating the Performances of Adaptive Kalman Filter Methods in GPS/INS Integration , 2010 .

[8]  Jun Zhang,et al.  Novel Technique for Vision-Based UAV Navigation , 2011, IEEE Transactions on Aerospace and Electronic Systems.

[9]  Stergios I. Roumeliotis,et al.  A Kalman Filter-Based Algorithm for IMU-Camera Calibration: Observability Analysis and Performance Evaluation , 2008, IEEE Transactions on Robotics.

[10]  R. Mehra.  On the identification of variances and adaptive Kalman filtering , 1970 .

[11]  Randal W. Beard,et al.  Real-Time Attitude and Position Estimation for Small UAVs Using Low-Cost Sensors , 2004 .

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

[13]  Peter S. Maybeck,et al.  Stochastic Models, Estimation And Control , 2012 .

[14]  L. B. Hostetler,et al.  Nonlinear Kalman filtering techniques for terrain-aided navigation , 1983 .

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

[16]  Matthijs C. Dorst.  Distinctive Image Features from Scale-Invariant Keypoints , 2011 .

[17]  Roland Siegwart,et al.  BRISK: Binary Robust invariant scalable keypoints , 2011, 2011 International Conference on Computer Vision.

[18]  Tae Yoon Um,et al.  Noise covariances estimation for systems with bias states , 2000, IEEE Trans. Aerosp. Electron. Syst..

[19]  M. E. Cannon,et al.  KALMAN FILTER RELIABILITY ANALYSIS USING DIFFERENT UPDATE STRATEGIES , 2003 .

[20]  Stergios I. Roumeliotis,et al.  Vision‐aided inertial navigation for pin‐point landing using observations of mapped landmarks , 2007, J. Field Robotics.

[21]  F. Gustafsson,et al.  Marginalized Particle Filter for Accurate and Reliable Terrain-Aided Navigation , 2009, IEEE Transactions on Aerospace and Electronic Systems.

[22]  Jinling Wang,et al.  Effective Adaptive Kalman Filter for MEMS-IMU/Magnetometers Integrated Attitude and Heading Reference Systems , 2012, Journal of Navigation.

[23]  A. H. Mohamed,et al.  Adaptive Kalman Filtering for INS/GPS , 1999 .

[24]  Dah-Jing Jwo,et al.  Unscented Kalman filter with nonlinear dynamic process modeling for GPS navigation , 2008 .

[25]  James B. Rawlings,et al.  A new autocovariance least-squares method for estimating noise covariances , 2006, Autom..

[26]  Jan Flusser,et al.  Image registration methods: a survey , 2003, Image Vis. Comput..