Kalman filtering with a class of geometric state equality constraints

P Chauchat (1, 2) , A Barrau (2) , S Bonnabel (1)

1 CAOR - Centre de Robotique
2 Safran Tech

— In this paper we consider a noise free left-invariant dynamics on a Lie group with noisy partial state measurements. We assume in addition that the covariance matrix of the state is initially rank-deficient. This, combined with the absence of process noise, makes the state necessary belong to a (time-dependent) subset of the state space at all times. We prove mathematically that the invariant extended Kalman filter (IEKF) perfectly respects this kind of state constraints, contrarily to the standard EKF, or the unscented Kalman filter. This is a strong indication that the IEKF is particularly well suited to navigation when motion sensors are highly precise. The theory is applied to a non-holonomic car example on SE(2), and to an attitude estimation example on SO(3).

Mots clés: Algebraic/geometric methods; Observers for nonlinear systems; Kalman filtering

Domaines: Mathématiques appliquées

P Chauchat, A Barrau, S Bonnabel. Kalman filtering with a class of geometric state equality constraints. 2017. ⟨hal-01580569v1⟩