[論文レビュー] SE(3) based Extended Kalman Filter for Spacecraft Attitude Estimation

Lubin Chang|arXiv (Cornell University)|Mar 29, 2020

Inertial Sensor and Navigation参考文献 24被引用数 6

ひとこと要約

本稿では、特別エウラー群 SE(3) を用いた拡張カルマンフィルタ（SE(3)-EKF）を提案し、姿勢とジャイロバイアスを SE(3) の要素としてモデル化することで、宇宙船の姿勢推定を実現する。SE(3) の幾何的構造を活用することで、幾何的拡張カルマンフィルタ（GEKF）を回復する統一的なフレームワークを提供し、不変フィルタリングの新たな視点を提示する。理論的側面では右不変 EKF と強く結びついており、姿勢推定における数値的安定性が向上する。

ABSTRACT

In this paper, the spacecraft attitude estimation problem has been investigated making use of the concept of matrix Lie group. Through formulation of the attitude and gyroscope bias as elements of SE(3), the corresponding extended Kalman filter, termed as SE(3)-EKF, has been derived. It is shown that the resulting SE(3)-EKF is just the newly-derived geometric extended Kalman filter (GEKF) for spacecraft attitude estimation. This provides a new perspective on the GEKF besides the common frame errors definition. Moreover, the SE(3)-EKF with reference frame attitude error is also derived and the resulting algorithm bears much resemblance to the right invariant EKF.

研究の動機と目的

• オイラー角やクォータニオンといった局所的パrameterization に依存する従来の姿勢推定手法の限界を解消すること。
• 宇宙船の姿勢とジャイロバイアスの内在的な多様体構造を尊重する幾何的に一貫したフィルタリングフレームワークの開発。
• SE(3) 群の定式化を通じて、幾何的拡張カルマンフィルタ（GEKF）の新しい導出を提供すること。
• SE(3)-EKF と既存の不変 EKF アプローチ（特に右不変 EKF）との理論的関係を確立すること。
• 従来の EKF に基づく推定で見られるクォータニオンやオイラー角による表現に内在する特異点を回避し、数値的条件を改善すること。

提案手法

• 宇宙船の姿勢とジャイロバイアスを、回転と並進を統合した統一された状態空間に持つ SE(3) 群の要素として定式化する。
• 幾何的整合性を保つために、SE(3) 上の行列指数関数および対数写像を用いて、状態遷移モデルと測定モデルを導出する。
• 群要素における接空間を用いて、現在の状態推定値の周囲でシステムダイナミクスと測定モデルを線形化することで、SE(3)-EKF を構築する。
• 群構造を活用して、対数写像による誤差状態を定義することで、推定誤差が接空間上に保たれ、幾何的不変性が維持されるようにする。
• SE(3) 上の状態遷移関数および測定関数のヤコビアンを用いて、共分散更新式を導出する。これにより、群の代数的性質と整合性を保つ。
• 得られたフィルタが幾何的 EKF（GEKF）と等価であり、右不変 EKF と構造的に類似していることを示し、その幾何的基盤を検証する。

実験結果

リサーチクエスチョン

• RQ1 姿勢とジャイロバイアス推定問題を、特徴的な特異点を避ける幾何的整合性を向上させる SE(3) 群を用いて再定式化できるか？
• RQ2 SE(3)-EKF と既存の幾何的拡張カルマンフィルタ（GEKF）との間には、定式化および性能面でどのような関係があるか？
• RQ3 SE(3)-EKF が右不変 EKF と等価または密接に関連していることを示すことができるか。これにより、その不変性特性が裏付けられるか？
• RQ4 クォータニオンやオイラー角を用いた従来の EKF 手法と比較して、SE(3)-EKF は特異点をどのように回避し、数値的条件を改善するか？
• RQ5 SE(3) フレームワークを用いることで、宇宙船の姿勢推定における不変オブザーバー設計にどのような影響があるか？

主な発見

• SE(3)-EKF は数学的に幾何的拡張カルマンフィルタ（GEKF）と等価であり、SE(3) 群構造を通じて GEKF の新しい幾何的導出を提供する。
• このフィルタ定式化は、オイラー角のような局所的パrameterization で一般的に見られる特異点や座標特異点を自然に回避する。
• 参照フレームの姿勢誤差を用いた SE(3)-EKF は、右不変 EKF に非常に類似しており、群作用における不変性特性が確認される。
• 誤差表現に対数写像を用いることで、推定誤差が SE(3) の接空間上に保たれ、幾何的構造が保持される。
• 提案手法は、姿勢とバイアス推定を1つのリー群内に統合する統一的フレームワークを提供し、数値的安定性と一貫性が向上する。
• GEKF および右不変 EKF との理論的同等性により、SE(3)-EKF は、宇宙船の姿勢推定における従来の EKF 手法の代替として、強固で幾何的に妥当な選択肢であることが立証される。