Invariant Trapezoidal Kalman Filter for Application to Attitude Estimation

This paper incorporates formal concepts of invariance of numerical integration schemes into the design of Kalman filters. In general terms, invariant discretizations of dynamical systems can form the basis for the derivation of the covariance propagation during the prediction and update phases of a Kalman filter, and this paper presents a framework to that effect. Specifically, natural invariants of angular motion are introduced, as part of a symmetry-preserving trapezoidal integration rule, to form the basis for the derivation of a discrete-time invariant Kalman filter for an attitude estimation problem. The proposed filter is realized by expressing all zero-mean random variables in the Lie algebra, while the state manipulations are performed in special orthogonal group 3. Simulation and experimental results are obtained using a neutrally buoyant spherical blimp to validate the proposed method against state-of-the-art Kalman filters in a broad range of angular speeds and sampling rates. Furthermore, the ...

[1]  F. Markley.  Attitude Error Representations for Kalman Filtering , 2003 .

[2]  Pilwon Kim,et al.  Invariantization of numerical schemes using moving frames , 2007 .

[3]  Inna Sharf,et al.  Invariant Momentum-tracking Kalman Filter for attitude estimation , 2012, 2012 IEEE International Conference on Robotics and Automation.

[4]  Geir Evensen,et al.  The Ensemble Kalman Filter: theoretical formulation and practical implementation , 2003 .

[5]  G. Dahlquist.  A special stability problem for linear multistep methods , 1963 .

[6]  I. Bar-Itzhack,et al.  Novel quaternion Kalman filter , 2002, IEEE Transactions on Aerospace and Electronic Systems.

[7]  J. Marsden,et al.  Discrete mechanics and variational integrators , 2001, Acta Numerica.

[8]  Daniele Mortari,et al.  Norm-Constrained Kalman Filtering , 2009 .

[9]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[10]  Alessandro Saccon,et al.  Midpoint rule for variational integrators on Lie groups , 2009 .

[11]  N. Bou-Rabee,et al.  Hamilton-Pontryagin Integrators on Lie Groups , 2007 .

[12]  Gerhard Schmeisser,et al.  Characterization of the speed of convergence of the trapezoidal rule , 1990 .

[13]  James M. Valpiani,et al.  Nonlinear Symplectic Attitude Estimation for Small Satellites , 2006 .

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

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

[16]  Patrick R. Girard,et al.  Quaternions, Clifford Algebras and Relativistic Physics , 2007 .

[17]  John L. Crassidis,et al.  Survey of nonlinear attitude estimation methods , 2007 .

[18]  N. McClamroch,et al.  Lie group variational integrators for the full body problem in orbital mechanics , 2007 .

[19]  Philippe Martin,et al.  Invariant Extended Kalman Filter: theory and application to a velocity-aided attitude estimation problem , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[20]  Philippe Martin,et al.  Generalized Multiplicative Extended Kalman Filter for Aided Attitude and Heading Reference System , 2010 .

[21]  Petr Krysl.  Direct time integration of rigid body motion with discrete‐impulse midpoint approximation: explicit Newmark algorithms , 2005 .

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