Augmented Cubature Kalman filter for nonlinear RTK/MIMU integrated navigation with non-additive noise

Abstract In order to enhance the capability of autonomous operation for small unmanned aerial vehicles (UAV), a MEMS-based inertial navigation system (INS)/global navigation satellite system (GNSS) integrated navigation method is proposed. An augmented Cubature Kalman filter is derived to fulfil the data fusion of precise GNSS real-time kinematic (RTK) solution and noisy inertial measurements. In the filter, Cubature Kalman filtering is adopted to handle the strong INS model nonlinearity caused by sudden and large UAV maneuvers, and the technique of state-augmentation is used to capture meaningful odd-order moment information and reduce the adverse impacts of non-additive noise in inertial measurements. It is analyzed that the basic difference between the augmented and non-augmented CKFs generally favors the augmented CKF, which is supported by a representative example and flight test. The results of flight test have also shown that the proposed augmented Cubature Kalman filtering method can complete more accurate navigation compared with the conventional EKF/UKF-based approaches.

[1]  Jingxiong Huang,et al.  The augmented form of cubature Kalman filter and quadrature Kalman filter for additive noise , 2009, 2009 IEEE Youth Conference on Information, Computing and Telecommunication.

[2]  D. Hu,et al.  Optimization-based alignment for inertial navigation systems: Theory and algorithm , 2011 .

[3]  Tao Yu,et al.  Design of adaptive robust square-root cubature Kalman filter with noise statistic estimator , 2015, Appl. Math. Comput..

[4]  P. Groves.  Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems , 2007 .

[5]  Lin Zhao,et al.  An Adaptive Unscented Kalman Filtering Algorithm for MEMS/GPS Integrated Navigation Systems , 2014, J. Appl. Math..

[6]  Eun-Hwan Shin,et al.  Unscented Kalman Filter and Attitude Errors of Low-Cost Inertial Navigation Systems , 2007 .

[7]  Qian Hua-Ming,et al.  A Generalized Augmented Gaussian Approximation Filter for Nonlinear Systems with Non-additive Correlated Noises , 2013, 2013 Third International Conference on Instrumentation, Measurement, Computer, Communication and Control.

[8]  Jianye Liu,et al.  An adaptive cubature Kalman filter algorithm for inertial and land-based navigation system , 2016 .

[9]  Jingjing Li,et al.  An adaptive navigation method for a small unmanned aerial rotorcraft under complex environment , 2013 .

[10]  Yingwei Zhao,et al.  Performance evaluation of Cubature Kalman filter in a GPS/IMU tightly-coupled navigation system , 2016, Signal Process..

[11]  Hugh F. Durrant-Whyte,et al.  A new method for the nonlinear transformation of means and covariances in filters and estimators , 2000, IEEE Trans. Autom. Control..

[12]  Zhu Xiao,et al.  GNSS/Low-Cost MEMS-INS Integration Using Variational Bayesian Adaptive Cubature Kalman Smoother and Ensemble Regularized ELM , 2015 .

[13]  Yuanxin Wu,et al.  Unscented Kalman filtering for additive noise case: augmented versus nonaugmented , 2005, IEEE Signal Processing Letters.

[14]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[15]  Meng Shao,et al.  Initial alignment on moving base using GPS measurements to construct new vectors , 2013 .

[16]  Eun-Hwan Shin,et al.  An unscented Kalman filter for in-motion alignment of low-cost IMUs , 2004, PLANS 2004. Position Location and Navigation Symposium (IEEE Cat. No.04CH37556).

[17]  Dah-Jing Jwo,et al.  Critical remarks on the linearised and extended Kalman filters with geodetic navigation examples , 2010 .

[18]  Yanming Feng,et al.  Analysis of a robust Kalman filter in loosely coupled GPS/INS navigation system , 2016 .

[19]  Ching-Yao Chan,et al.  Reliable vehicle sideslip angle fusion estimation using low-cost sensors , 2014 .

[20]  Peter M. G. Silson,et al.  Coarse Alignment of a Ship's Strapdown Inertial Attitude Reference System Using Velocity Loci , 2011, IEEE Transactions on Instrumentation and Measurement.

[21]  Jie Wu,et al.  Novel In-flight Coarse Alignment of Low-cost Strapdown Inertial Navigation System for Unmanned Aerial Vehicle Applications , 2016 .

[22]  Sergio de La Parra,et al.  Low cost navigation system for UAV's , 2005 .

[23]  Yuanxin Wu,et al.  Velocity/Position Integration Formula Part I: Application to In-Flight Coarse Alignment , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[24]  Masayoshi Tomizuka,et al.  Novel hybrid of strong tracking Kalman filter and wavelet neural network for GPS/INS during GPS outages , 2013 .

[25]  Reynald Hoskinson,et al.  A cascaded Kalman filter-based GPS/MEMS-IMU integration for sports applications , 2015 .

[26]  Wei Huang,et al.  A robust strong tracking cubature Kalman filter for spacecraft attitude estimation with quaternion constraint , 2016 .

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

[28]  Lu Zhang,et al.  Two-stage cubature Kalman filter for nonlinear system with random bias , 2014, 2014 International Conference on Multisensor Fusion and Information Integration for Intelligent Systems (MFI).

[29]  Tao Zhang,et al.  A new method of seamless land navigation for GPS/INS integrated system , 2012 .

[30]  Fuh-Gwo Yuan,et al.  A 3D collision avoidance strategy for UAV with physical constraints , 2016 .

[31]  Jinling Wang,et al.  A Novel Initial Alignment Scheme for Low-Cost INS Aided by GPS for Land Vehicle Applications , 2010, Journal of Navigation.

[32]  Huang Jianjun,et al.  A CKF based spatial alignment of radar and infrared sensors , 2010, IEEE 10th INTERNATIONAL CONFERENCE ON SIGNAL PROCESSING PROCEEDINGS.

[33]  Jan Wendel,et al.  An integrated GPS/MEMS-IMU navigation system for an autonomous helicopter , 2006 .

[34]  Robert M. Rogers.  IMU IN-MOTION ALIGNMENT WITHOUT BENEFIT OF ATTITUDE INITIALIZATION , 1997 .

[35]  Yuanxin Wu,et al.  A Numerical-Integration Perspective on Gaussian Filters , 2006, IEEE Transactions on Signal Processing.

[36]  Hanlin Sheng,et al.  MEMS-based low-cost strap-down AHRS research , 2015 .

[37]  Junping Du,et al.  Distributed Multiple-Model Estimation for Simultaneous Localization and Tracking With NLOS Mitigation , 2013, IEEE Transactions on Vehicular Technology.

[38]  S. Haykin,et al.  Cubature Kalman Filters , 2009, IEEE Transactions on Automatic Control.