Invariant Kalman Filtering with Noise-Free Pseudo-Measurements

Sven Goffin, Silvère Bonnabel, Olivier Brüls +1

In this paper, we focus on developing an Invariant Extended Kalman Filter (IEKF) for extended pose estimation for a noisy system with state equality constraints. We treat those con…