A Simple Attitude Unscented Kalman Filter: Theory and Evaluation in a Magnetometer-Only Spacecraft Scenario

A quaternion-based attitude unscented Kalman filter is formulated with quaternion errors parameterized by small angle approximations and is applied to a filter with a state vector consisting of the attitude quaternion and the gyro bias vector. The filter is evaluated using extensive Monte Carlo data in a simulated lost-in-space scenario of a low-Earth orbiting spacecraft processing only three-axis magnetometer and gyro measurements. The filter is found to be robust, accurate, and rapidly convergent in this scenario for small true gyro biases and small initial uncertainties in their values, often converging in only one half of an orbit period to an attitude accuracy of 0.1 degrees. The filter convergence is found to depend significantly on the value of the true gyro biases as well as the initial gyro bias covariances. Monte Carlo results also indicate that this unscented Kalman filter is significantly less robust than an extended Kalman filter with the same attitude approach, but performs slightly better than another unscented Kalman filter with a generalized Rodrigues parameter approach to quaternion errors.

[1]  Jonathan P. How,et al.  Nonlinearity in Sensor Fusion: Divergence Issues in EKF, modified truncated SOF, and UKF , 2007 .

[2]  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..

[3]  E. Kraft,et al.  A quaternion-based unscented Kalman filter for orientation tracking , 2003, Sixth International Conference of Information Fusion, 2003. Proceedings of the.

[4]  Joris De Schutter,et al.  Kalman filters for nonlinear systems , 2002 .

[5]  Mark L. Psiaki,et al.  N 8 9 - 1 5 9 5 1 Three-Axis Attitude Determination via Kalman Filtering of Magnetometer Data , 2003 .

[6]  R. Farrenkopf.  Analytic Steady-State Accuracy Solutions for Two Common Spacecraft Attitude Estimators , 1978 .

[7]  M. Shuster.  A survey of attitude representation , 1993 .

[8]  Melanie Hartmann,et al.  Spacecraft Attitude Determination And Control , 2016 .

[9]  Joseph E. Sedlak,et al.  The use of magnetometers for accurate attitude determination , 1997 .

[10]  John L. Crassidis,et al.  In-Space Spacecraft Alignment Calibration Using the Unscented Filter , 2003 .

[11]  Itzhack Y. Bar-Itzhack,et al.  Evaluation of Attitude and Orbit Estimation Using Actual Earth Magnetic Field Data , 2001 .

[12]  F. Markley,et al.  Unscented Filtering for Spacecraft Attitude Estimation , 2003 .

[13]  Mark L. Psiaki,et al.  Global Magnetometer-Based Spacecraft Attitude and Rate Estimation , 2003 .

[14]  G. A. Natanson,et al.  Advantages of Estimating Rate Corrections During Dynamic Propagation of Spacecraft Rates-Application , 1994 .

[15]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

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

[17]  Itzhack Y. Bar-Itzhack,et al.  An Innovative Method for Low Cost, Autonomous Navigation for Low Earth Orbit Satellites , 1998 .

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

[19]  Bruce A. McElhoe,et al.  An Assessment of the Navigation and Course Corrections for a Manned Flyby of Mars or Venus , 1966, IEEE Transactions on Aerospace and Electronic Systems.

[20]  Mohammed Benjelloun,et al.  Quaternion Unscented Kalman Filtering for integrated Inertial Navigation and GPS , 2008, 2008 11th International Conference on Information Fusion.

[21]  Jong-Hwan Kim,et al.  Unscented Filtering in a Unit Quaternion Space for Spacecraft Attitude Estimation , 2007, 2007 IEEE International Symposium on Industrial Electronics.

[22]  Parimal Pal,et al.  Magnetometer based attitude determination system using a reduced order Kalman filter , 1996 .

[23]  Arthur Gelb,et al.  Applied Optimal Estimation , 1974 .

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

[25]  Mishari Alarfaj,et al.  INTERACTIONS OF POSE ESTIMATION AND ONLINE DYNAMIC MODELING FOR A SMALL INSPECTOR SPACECRAFT , 2010 .

[26]  Henry J. Pernicka,et al.  Magnetometer-only Attitude Determination Using Novel Two-step Kalman Filter Approach , 2012 .

[27]  H. C. Corben,et al.  Classical Mechanics (2nd ed.) , 1961 .

[28]  J. W. Murrell,et al.  Precision attitude determination for multimission spacecraft , 1978 .

[29]  Marcello R. Napolitano,et al.  Evaluation of Matrix Square Root Operations for UKF within a UAV GPS/INS Sensor Fusion Application , 2011 .

[30]  Rudolph van der Merwe,et al.  The unscented Kalman filter for nonlinear estimation , 2000, Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No.00EX373).

[31]  S. F. Schmidt.  APPLICATION OF STATISTICAL FILTER THEORY TO THE OPTIMAL ESTIMATION OF POSITION AND VELOCITY ON BOARD A CIRCUMLUNAR VEHICLE , 2022 .

[32]  R. Farrenkopf.  Generalized results for precision attitude reference systems using gyros , 1974 .

[33]  M. Challa,et al.  Magnetometer-Only Attitude and Rate Estimates for Spinning Spacecraft , 2000 .

[34]  Shin-ichiro Sakai,et al.  Residual Based Adaptive Unscented Kalman Filter for Satellite Attitude Estimation , 2012 .

[35]  E. J. Lefferts,et al.  Kalman Filtering for Spacecraft Attitude Estimation , 1982 .