Evaluation of Matrix Square Root Operations for UKF within a UAV GPS/INS Sensor Fusion Application

Using an Unscented Kalman Filter (UKF) as the nonlinear estimator within a Global Positioning System/Inertial Navigation System (GPS/INS) sensor fusion algorithm for attitude estimation, various methods of calculating the matrix square root were discussed and compared. Specifically, the diagonalization method, Schur method, Cholesky method, and five different iterative methods were compared. Additionally, a different method of handling the matrix square root requirement, the square-root UKF (SR-UKF), was evaluated. The different matrix square root calculations were compared based on computational requirements and the sensor fusion attitude estimation performance, which was evaluated using flight data from an Unmanned Aerial Vehicle (UAV). The roll and pitch angle estimates were compared with independently measured values from a high quality mechanical vertical gyroscope. This manuscript represents the first comprehensive analysis of the matrix square root calculations in the context of UKF. From this analysis, it was determined that the best overall matrix square root calculation for UKF applications in terms of performance and execution time is the Cholesky method.

[1]  Marcello R. Napolitano,et al.  Design and Flight Testing Evaluation of Formation Control Laws , 2006, IEEE Transactions on Control Systems Technology.

[2]  Elliott D. Kaplan.  Understanding GPS : principles and applications , 1996 .

[3]  Debby Andrews.  Global Positioning , 2004 .

[4]  Shen Li,et al.  The research on unmanned aerial vehicle remote sensing and its applications , 2010, 2010 2nd International Conference on Advanced Computer Control.

[5]  G. Campa,et al.  3-Aircraft Formation Flight Experiment , 2006, 2006 14th Mediterranean Conference on Control and Automation.

[6]  N. Higham.  Analysis of the Cholesky Decomposition of a Semi-definite Matrix , 1990 .

[7]  Marcello R. Napolitano,et al.  Aircraft Attitude, Position, and Velocity Determination Using Sensor Fusion , 2008 .

[8]  Victor M. Becerra,et al.  Optimal control , 2008, Scholarpedia.

[9]  Guoqing Zhou,et al.  Civil UAV system for earth observation , 2007, 2007 IEEE International Geoscience and Remote Sensing Symposium.

[10]  E. Kreyszig,et al.  Advanced Engineering Mathematics. , 1974 .

[11]  Costanzo Manes,et al.  Comparative Study of Unscented Kalman Filter and Extended Kalman Filter for Position/Attitude Estimation in Unmanned Aerial Vehicles , 2008 .

[12]  Yangquan Chen,et al.  Low-Cost Multispectral Aerial Imaging using Autonomous Runway-Free Small Flying Wing Vehicles , 2008, IGARSS 2008 - 2008 IEEE International Geoscience and Remote Sensing Symposium.

[13]  Yuanxin Wu,et al.  Unscented Kalman filtering for additive noise case: augmented vs. non-augmented , 2005, Proceedings of the 2005, American Control Conference, 2005..

[14]  Taro Suzuki,et al.  Vision based localization of a small UAV for generating a large mosaic image , 2010, Proceedings of SICE Annual Conference 2010.

[15]  Marcello R. Napolitano,et al.  A Comparison of Extended Kalman Filter, Sigma-Point Kalman Filter, and Particle Filter in GPS/INS Sensor Fusion , 2010 .

[16]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[17]  Fuming Sun,et al.  Unscented Kalman Filter Using Augmented State in the Presence of Additive Noise , 2009, 2009 IITA International Conference on Control, Automation and Systems Engineering (case 2009).

[18]  G. Campa,et al.  Comparison of Different Neural Augmentations for the Fault Tolerant Control Laws of the WVU YF-22 Model Aircraft , 2006, 2006 14th Mediterranean Conference on Control and Automation.

[19]  Mei Han An,et al.  accuracy and stability of numerical algorithms , 1991 .

[20]  Rudolph van der Merwe,et al.  The square-root unscented Kalman filter for state and parameter-estimation , 2001, 2001 IEEE International Conference on Acoustics, Speech, and Signal Processing. Proceedings (Cat. No.01CH37221).

[21]  Dan Simon,et al.  Optimal State Estimation: Kalman, H∞, and Nonlinear Approaches , 2006 .

[22]  Nicholas J. Higham,et al.  Functions of matrices - theory and computation , 2008 .

[23]  Kirtland Afb,et al.  Comparison of the Extended and Unscented Kalman Filters for Angles Based Relative Navigation , 2008 .

[24]  Ryosuke Shibasaki,et al.  UAV-Borne 3-D Mapping System by Multisensor Integration , 2009, IEEE Transactions on Geoscience and Remote Sensing.

[25]  A. Föhrenbach,et al.  SIMPLE++ , 2000, OR Spectr..

[26]  R. E. Kalman,et al.  New Results in Linear Filtering and Prediction Theory , 1961 .

[27]  John L. Crassidis.  Sigma-point Kalman filtering for integrated GPS and inertial navigation , 2006 .

[28]  Philipp Birken,et al.  Numerical Linear Algebra , 2011, Encyclopedia of Parallel Computing.

[29]  Marcello R. Napolitano,et al.  Integrated Avionic ( ARIA ) System for Fault-Tolerant Flight Research , 2009 .

[30]  V. Mehrmann,et al.  Perturbation theory for matrix equations , 2003, IEEE Transactions on Automatic Control.

[31]  S. A. Banani,et al.  A New Version of Unscented Kalman Filter , 2007 .

[32]  BEATRICE MEINI,et al.  The Matrix Square Root from a New Functional Perspective: Theoretical Results and Computational Issues , 2005, SIAM J. Matrix Anal. Appl..

[33]  Marcello R. Napolitano,et al.  Flight-Test Evaluation of Sensor Fusion Algorithms for Attitude Estimation , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[34]  A Ficusului.  REMOTE SENSING USING AUTONOMOUS UAVs SUITABLE FOR LESS DEVELOPED COUNTRIES , 2006 .

[35]  Marcello R. Napolitano,et al.  A Systematic Approach for Extended Kalman Filter Tuning and Low-Cost Inertial Sensor Calibration within a GPS/INS Application , 2010 .

[36]  M. C. VanDyke,et al.  UNSCENTED KALMAN FILTERING FOR SPACECRAFT ATTITUDE STATE AND PARAMETER ESTIMATION , 2004 .

[37]  N. Higham.  Newton's method for the matrix square root , 1986 .

[38]  Jan Wendel,et al.  A Performance Comparison of Tightly Coupled GPS/INS Navigation Systems based on Extended and Sigma Point Kalman Filters , 2005 .

[39]  Srikanth Gururajan,et al.  Autonomous Formation Flight: Hardware Development , 2006, 2006 14th Mediterranean Conference on Control and Automation.

[40]  Nicholas J. Higham,et al.  Approximating the Logarithm of a Matrix to Specified Accuracy , 2000, SIAM J. Matrix Anal. Appl..

[41]  Donald A. McQuarrie.  Mathematical Methods for Scientists and Engineers , 2003 .

[42]  Donald W. Tufts,et al.  Simple, effective computation of principal eigenvectors and their eigenvalues and application to high-resolution estimation of frequencies , 1986, IEEE Trans. Acoust. Speech Signal Process..

[43]  Marcello R. Napolitano,et al.  Sensitivity Analysis of EKF and UKF in GPS/INS Sensor Fusion , 2011 .