Second-Order-Optimal Minimum-Energy Filters on Lie Groups

Systems on Lie groups naturally appear as models for physical systems with full symmetry. We consider the state estimation problem for such systems where both input and output measurements are corrupted by unknown disturbances. We provide an explicit formula for the second-order-optimal nonlinear filter on a general Lie group where optimality is with respect to a deterministic cost measuring the cumulative energy in the unknown system disturbances (minimum-energy filtering). The resulting filter depends on the choice of affine connection which encodes the nonlinear geometry of the state space. As an example, we look at attitude estimation, where we are given a second order mechanical system on the tangent bundle of the special orthogonal group SO(3), namely the rigid body kinematics together with the Euler equation. When we choose the symmetric Cartan-Schouten (0)-connection, the resulting filter has the familiar form of a gradient observer combined with a perturbed matrix Riccati differential equation that updates the filter gain. This example demonstrates how to construct a matrix representation of the abstract general filter formula.

[1]  K. Nomizu.  Invariant Affine Connections on Homogeneous Spaces , 1954 .

[2]  J. Marsden,et al.  Introduction to mechanics and symmetry , 1994 .

[3]  Mohammad Zamani,et al.  Deterministic Attitude and Pose Filtering, an Embedded Lie Groups Approach , 2013 .

[4]  John Hauser,et al.  Lie group projection operator approach: Optimal control on T SO(3) , 2011, IEEE Conference on Decision and Control and European Control Conference.

[5]  A. D. Lewis,et al.  Geometric Control of Mechanical Systems , 2004, IEEE Transactions on Automatic Control.

[6]  H. Sussmann,et al.  Control systems on Lie groups , 1972 .

[7]  John M. Lee.  Riemannian Manifolds: An Introduction to Curvature , 1997 .

[8]  A. Bloch,et al.  Nonholonomic Mechanics and Control , 2004, IEEE Transactions on Automatic Control.

[9]  W. Boothby.  An introduction to differentiable manifolds and Riemannian geometry , 1975 .

[10]  P. Krishnaprasad,et al.  Control Systems on Lie Groups , 2005 .

[11]  R. Mortensen.  Maximum-likelihood recursive nonlinear filtering , 1968 .

[12]  Robert E. Mahony,et al.  Optimization Algorithms on Matrix Manifolds , 2007 .

[13]  Robert E. Mahony,et al.  On the distance to optimality of the geometric approximate minimum-energy attitude filter , 2014, 2014 American Control Conference.

[14]  Robert E. Mahony,et al.  Minimum-Energy Filtering for Attitude Estimation , 2013, IEEE Transactions on Automatic Control.

[15]  W. Marsden.  I and J , 2012 .

[16]  Robert E. Mahony,et al.  Near-Optimal Deterministic Filtering on the Rotation Group , 2011, IEEE Transactions on Automatic Control.

[17]  W. Rossmann.  Lie Groups: An Introduction through Linear Groups , 2002 .

[18]  A. Jazwinski.  Stochastic Processes and Filtering Theory , 1970 .

[19]  R. Abraham,et al.  Manifolds, Tensor Analysis, and Applications , 1983 .

[20]  João Pedro Hespanha,et al.  Minimum-energy state estimation for systems with perspective outputs , 2006, IEEE Transactions on Automatic Control.

[21]  Robert E. Mahony,et al.  Second-order-optimal filters on Lie groups , 2013, 52nd IEEE Conference on Decision and Control.

[22]  Paul William Coote,et al.  Near-optimal deterministic filtering on the unit circle , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[23]  Christoph Schnörr,et al.  Second Order Minimum Energy Filtering on $${\text {SE}}_{3}$$ with Nonlinear Measurement Equations , 2015, SSVM.

[24]  V. Jurdjevic.  Geometric control theory , 1996 .

[25]  R. Brockett.  System Theory on Group Manifolds and Coset Spaces , 1972 .

[26]  John Hauser,et al.  Optimal Control on Lie Groups: The Projection Operator Approach , 2013, IEEE Transactions on Automatic Control.

[27]  R. Carter.  Lie Groups , 1970, Nature.

[28]  Arthur J. Krener.  The Convergence of the Minimum Energy Estimator , 2003 .