Equivariant Symmetries for Aided Inertial Navigation

TL;DR

This paper introduces a novel equivariant filter for inertial navigation systems that explicitly incorporates IMU biases, leveraging system symmetries to improve accuracy, robustness, and convergence.

Contribution

It develops the first equivariant symmetry for inertial navigation systems with biases, enabling the design of superior filtering algorithms based on symmetry principles.

Findings

The equivariant filter outperforms state-of-the-art solutions in accuracy.

The filter demonstrates improved convergence and robustness.

Formalizes the role of symmetry in filter performance.

Abstract

Respecting the geometry of the underlying system and exploiting its symmetry have been driving concepts in deriving modern geometric filters for inertial navigation systems (INSs). Despite their success, the explicit treatment of inertial measurement unit (IMU) biases remains challenging, unveiling a gap in the current theory of filter design. In response to this gap, this dissertation builds upon the recent theory of equivariant systems to address and overcome the limitations in existing methodologies. The goal is to identify new symmetries of inertial navigation systems that include a geometric treatment of IMU biases and exploit them to design filtering algorithms that outperform state-of-the-art solutions in terms of accuracy, convergence rate, robustness, and consistency. This dissertation leverages the semi-direct product rule and introduces the tangent group for inertial navigation systems as the first equivariant symmetry that properly accounts for IMU biases. Based on that, we show that it is possible to derive an equivariant filter (EqF) algorithm with autonomous navigation error dynamics. The resulting filter demonstrates superior to state-of-the-art solutions. Through a comprehensive analysis of various symmetries of inertial navigation systems, we formalized the concept that every filter can be derived as an EqF with a specific choice of symmetry. This underlines the fundamental role of symmetry in determining filter performance. This dissertation advances the understanding of equivariant symmetries in the context of inertial navigation systems and serves as a basis for the next generation of equivariant estimators, marking a significant leap toward more reliable navigation solutions.