[論文レビュー] Equivariant Symmetries for Inertial Navigation Systems

Alessandro Fornasier, Yixiao Ge+3 more|arXiv (Cornell University)|Sep 7, 2023

Inertial Sensor and Navigation被引用数 5

ひとこと要約

本論文は、現代の拡張カルマンフィルタ（EKF）変種を、Lie群 SO(3)×R³×R³×R 上の対称性群を用いた同値フィルタ（EqF）手法の具体例として解釈することで、慣性航法システム（INS）フィルタリングの統一的枠組みを提案する。IMUおよびGNSSを搭載したINSに対して2つの新しい対称性を導入し、対称性の選択がフィルタ性能に直接影響することを示し、実用的な最適アルゴリズム選定の根拠を提供する。

ABSTRACT

This paper investigates the problem of inertial navigation system (INS) filter design through the lens of symmetry. The extended Kalman filter (EKF) and its variants have been the staple of INS filtering for 50 years. However, recent advances in inertial navigation systems have exploited matrix Lie group structure to design stochastic filters and state observers that have been shown to display superior performance compared to classical solutions. In this work, we explore various symmetries of inertial navigation system, including two novel symmetries that have not been considered in the prior literature, and provide a discussion of the relative strengths and weaknesses of these symmetries in the context of filter design. We show that all the modern variants of the EKF for inertial navigation can be interpreted as the recently proposed equivariant filter (EqF) design methodology applied to different choices of symmetry group for the INS problem. As a direct application of the symmetries presented, we address the filter design problem for a vehicle equipped with an inertial measurement unit (IMU) and a global navigation satellite system (GNSS) receiver, providing a comparative analysis of different modern filter solutions. We believe the collection of symmetries that we present here capture all the sensible choices of symmetry for this problem, and that the analysis provided is indicative of the relative real-world performance potential of the different algorithms for trajectories ensuring full state observability.

研究の動機と目的

• EKFに基づく現代のINSフィルタを、同値フィルタの枠組みで統一すること。
• IMUおよびGNSSセンサを備えたINSに適用可能な、すべての妥当な対称性群を特定・形式化すること。
• 従来の文献で検討されていなかった、INSフィルタリングのための2つの新しい対称性を提案すること。
• 既存および新しい対称性に基づくフィルタリング手法の相対的な長所と短所を比較すること。
• 対称性構造に基づいた、アルゴリズムの性能ポテンシャルの根拠ある分析を提供すること。

提案手法

• 著者らは、状態推定を対称性を保つ推論問題として扱うことで、INS問題に同値フィルタ（EqF）設計手法を適用する。
• IMUおよびGNSSを備えたINSの状態空間の背後にある多様体として、対称性群 SO(3)×R³×R³×R を特定する。
• 異なる対称性部分群の選択を分析することで、既存のEKF変種がEqFフレームワークの特定のインスタンスとして導出・解釈されることを示す。
• システムダイナミクスにおける構造的不変性に基づき、従来のINSフィルタで用いられていなかった2つの新しい対称性群を導入する。
• このフレームワークにより、選択された対称性群の下で幾何的および確率的不変性を保つフィルタの体系的導出が可能になる。
• 推定精度および収束性への影響を踏まえた、対称性に起因する不変性特性の理論的分析と、その結果の比較評価を通じて性能比較が行われる。

実験結果

リサーチクエスチョン

• RQ1 既存のEKFベースのINSフィルタは、どのように同値フィルタの観点から体系的に解釈できるか？
• RQ2 IMUおよびGNSS受信機を備えたINSに、物理的および数学的に妥当なすべての対称性群は何か？
• RQ3 INS問題に改善された推定性能をもたらす、新たな対称性は何か？
• RQ4 対称性群の選択は、INSにおける状態推定のロバストネスおよび精度にどのように影響するか？
• RQ5 実世界のシナリオにおいて、さまざまな対称性に基づくフィルタリングアルゴリズムの理論的性能ポテンシャルは何か？

主な発見

• IMUおよびGNSSを備えたINSにおける現代のEKF変種は、すべて異なる対称性群の選択の下で、同値フィルタ（EqF）の特定のインスタンスとして解釈可能である。
• 提案されたフレームワークにより、指定されたセンサセットに適したすべての妥当な対称性群が特定・形式化され、可能な対称的フィルタの完全な分類が得られた。
• 従来の文献で検討されていなかった2つの新しい対称性が導入され、幾何的に整合性のあるINSフィルタの設計空間が拡張された。
• 対称性構造が推定性能に直接影響し、より強い不変性特性を有する場合、ロバストネスおよび精度が向上することが示された。
• 分析から、対称性の選択が実世界のフィルタ性能の主要因であることが示唆され、実用的なアルゴリズム選定に影響を与える。
• このフレームワークは、内在するシステム対称性を保つ未来のINSフィルタ設計の根拠ある幾何的基盤を提供する。