Iterated Invariant EKF pour navigation inertielle 3D assistée par repères visuels
Des chercheurs présentent pour la première fois l'application du filtre de Kalman étendu invariant itéré (IterIEKF) à la localisation inertielle 3D assistée par repères visuels (landmarks). L'étude, publiée le 2 juillet 2026 sur arXiv, compare cette approche à trois méthodes de référence: le filtre de Kalman étendu classique basé sur SO(3) (SO(3)-EKF), sa version itérée, et le filtre de Kalman étendu invariant (IEKF) standard. Via des simulations numériques, les auteurs montrent que l'IterIEKF surpasse les trois autres approches à la fois en précision d'estimation et en cohérence de l'incertitude calculée par le filtre.
Le problème visé est la "fausse observabilité", un défaut connu des EKF basés sur SO(3): le filtre devient artificiellement trop confiant dans des directions de l'espace d'état qui ne sont en réalité pas observables, ce qui dégrade la précision de la localisation au fil du temps. C'est un enjeu critique pour tout système de navigation inertielle combinant IMU et mesures de repères visuels ou lidar afin d'estimer position et orientation sans GPS, comme les drones, robots mobiles, AMR industriels ou véhicules autonomes. L'IEKF corrige en partie ce biais en reformulant la dynamique du système comme un système "group-affine" sur un groupe de Lie, mais sa mise à jour ne respecte pas totalement certaines propriétés de compatibilité d'état. L'IterIEKF comble cet écart en garantissant, en régime de faible bruit, que l'état estimé reste sur la variété observée pendant que l'incertitude reste confinée à son espace tangent, un raffinement qui promet une estimation plus fiable et moins de dérive.
Ce travail s'inscrit dans la lignée des filtres invariants sur groupes de Lie, devenus ces dernières années une alternative de référence aux EKF classiques pour la fusion IMU/vision en robotique et en SLAM. L'IterIEKF avait déjà été proposé comme amélioration générique de l'IEKF, mais son application à la localisation 3D par repères n'avait pas encore été formalisée ni évaluée: c'est la contribution revendiquée ici. Les résultats restent pour l'instant cantonnés à des simulations numériques, une étape préalable avant toute validation sur capteurs réels, où bruit et biais diffèrent des hypothèses idéalisées du papier. Reste donc à voir si ce gain théorique se traduira par un bénéfice mesurable sur des plateformes embarquées.
Dans nos dossiers




