Nonlinearity in Sensor Fusion: Divergence Issues in EKF, modified truncated SOF, and UKF

Relative navigation is a challenging technological component of many planned NASA and ESA missions. It typically uses recursive filters to fuse measurements (e.g., range and angle) from sensors with contrasting accuracies to estimate the vehicle state vectors in real time. The tendency of Extended Kalman filter to diverge under these conditions is well documented in the literature. As such, we have investigated the application of the modified truncated Second-Order Filter (mtSOF) and the Unscented Kalman filter (UKF) to those mission scenarios using numerical simulations of a representative experimental configuration: estimation of a static position in space using distance and angle measurements. These simulation results showed that the mtSOF and UKF may also converge to an incorrect state estimate. A detailed study establishes the divergence process of the mtSOF and UKF, and designs new strategies that improve the accuracy of these filters.

[1]  Max Donath,et al.  American Control Conference , 1993 .

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

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

[4]  Philip Ferguson,et al.  Decentralized Estimation Algorithms for Formation Flying Spacecraft , 2003 .

[5]  Herman Bruyninckx,et al.  Comment on "A new method for the nonlinear transformation of means and covariances in filters and estimators" [with authors' reply] , 2002, IEEE Trans. Autom. Control..

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

[7]  John C. Nash,et al.  Nonlinear parameter estimation: an integrated system in BASIC , 1987 .

[8]  F.Y. Hadaegh,et al.  A survey of spacecraft formation flying guidance and control. Part II: control , 2004, Proceedings of the 2004 American Control Conference.

[9]  S Julier,et al.  Comment on "A new method for the nonlinear transformation of means and covariances in filters and estimators" - Reply , 2002 .

[10]  S. Ploen,et al.  A survey of spacecraft formation flying guidance and control (part 1): guidance , 2003, Proceedings of the 2003 American Control Conference, 2003..

[11]  Richard A. Brown,et al.  Introduction to random signals and applied kalman filtering (3rd ed , 2012 .

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

[13]  Edward W. Kamen,et al.  New nonlinear iterated filter with applications to target tracking , 1995, Optics & Photonics.

[14]  J. Borde,et al.  Feasibility of the Proba 3 formation flying demonstration mission as a pair of microsats in GTO , 2004 .

[15]  Branko Ristic,et al.  Beyond the Kalman Filter: Particle Filters for Tracking Applications , 2004 .

[16]  Herman Bruyninckx,et al.  Kalman filters for non-linear systems: a comparison of performance , 2004 .

[17]  Lefebvre de Plinval-Salgues,et al.  Analysis of relative navigation architectures for formation flying spacecrafts , 2006 .

[18]  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).

[19]  Charles A. Beichman,et al.  Terrestrial Planet Finder: the search for life-bearing planets around other stars , 1998, Astronomical Telescopes and Instrumentation.

[20]  David K. Geller,et al.  Linear Covariance Techniques for Orbital Rendezvous Analysis and Autonomous Onboard Mission Planning , 2005 .