Optimization-Based VINS: Consistency, Marginalization, and FEJ

In this work, we present a comprehensive analysis of the application of the First-estimates Jacobian (FEJ) design methodology in nonlinear optimization-based Visual-Inertial Navigation Systems (VINS). The FEJ approach fixes system linearization points to preserve proper observability properties of V...

Ausführliche Beschreibung

Gespeichert in:
Bibliographische Detailangaben
Veröffentlicht in:Proceedings of the ... IEEE/RSJ International Conference on Intelligent Robots and Systems S. 1517 - 1524
Hauptverfasser: Chen, Chuchu, Geneva, Patrick, Peng, Yuxiang, Lee, Woosik, Huang, Guoquan
Format: Tagungsbericht
Sprache:Englisch
Veröffentlicht: IEEE 01.10.2023
Schlagworte:
Design methodology
Estimation
Guidelines
Intelligent robots
Jacobian matrices
Navigation
Observability
ISSN:2153-0866
Online-Zugang:Volltext
Tags: Tag hinzufügen
Keine Tags, Fügen Sie den ersten Tag hinzu!
Beschreibung
Zusammenfassung:In this work, we present a comprehensive analysis of the application of the First-estimates Jacobian (FEJ) design methodology in nonlinear optimization-based Visual-Inertial Navigation Systems (VINS). The FEJ approach fixes system linearization points to preserve proper observability properties of VINS and has been shown to significantly improve the estimation performance of state-of-the-art filtering-based methods. However, its direct application to optimization-based estimators holds challenges and pitfalls, which we addressed in this paper. Specifically, we carefully examine the observability and its relation to inconsistency and FEJ, based on this, we explain how to properly apply and implement FEJ within four marginalization archetypes commonly used in non-linear optimizationbased frameworks. FEJ's effectiveness and applications to VINS are investigated and demonstrate significant performance improvements. Additionally, we offer a detailed discussion of results and guidelines on how to properly implement FEJ in optimization-based estimators.
ISSN:2153-0866
DOI:10.1109/IROS55552.2023.10341637