[論文レビュー] Kalman Filtering in the Presence of State Space Equality Constraints

Nachi Gupta|ArXiv.org|May 31, 2007

Target Tracking and Data Fusion in Sensor Networks参考文献 5被引用数 10

ひとこと要約

本論文は、カルマンフィルタリングに状態空間等式制約を組み込むための2つの数学的に同等の手法—測定値拡張法と射影ベース推定法—を提示し、比較している。特定の条件下で、両手法が同一の制約付き推定分布をもたらすことを証明しており、実装の簡便さと計算効率の間で実務家が選択肢を持つことを示している。

ABSTRACT

We discuss two separate techniques for Kalman Filtering in the presence of state space equality constraints. We then prove that despite the lack of similarity in their formulations, under certain conditions, the two methods result in mathematically equivalent constrained estimate structures. We conclude that the potential benefits of using equality constraints in Kalman Filtering often outweigh the computational costs, and as such, equality constraints, when present, should be enforced by way of one of these two methods.

研究の動機と目的

• 従来のカルマンフィルタリングにおいて状態空間等式制約が十分に活用されていないことによる、非最適な推定を是正すること。
• 等式制約をカルマンフィルタに強制するための2つの異なるアプローチ—測定値拡張法と射影法—を形式化し、比較すること。
• 明確に定義された条件下で、2つの手法が数学的に同等であることを確立し、一貫した推定結果を保証すること。
• 制約を組み込むことで誤差共分散が小さくなり、推定精度が向上することを示し、計算コストを正当化すること。
• 非線形問題や不等式制約問題への拡張を、線形化またはアクティブセット法を用いて可能にする基盤を提供すること。

提案手法

• 最初の手法は、各時刻で等式制約を表す完全でノイズのない測定値を測定モデルに追加する。
• 2番目の手法は、非制約付きカルマン推定値を計算し、疑似逆行列または最適化ベースの射影を用いて制約部分空間に射影する。
• 本論文は、標準的なカルマンフィルタ方程式と行列代数に依拠して、両手法を用いた制約付き状態推定値および誤差共分散の解析的表現を導出する。
• 拡張手法におけるイノベーション共分散行列の逆行列の閉形式表現を導出するために、サドルポイント行列の逆行列およびシュール補行列の恒等式を用いる。
• 2つの手法の同等性の証明は、カルマンゲイン、誤差共分散、制約行列を含む行列恒等式に依拠しており、非特異性条件のもとで最終的な推定値が同一であることを示している。
• 数値実装において対称性と正定値性を保つために、ジョゼフ形式の誤差共分散が推奨される。

実験結果

リサーチクエスチョン

• RQ1 測定値拡張法と射影ベース推定法が、等式制約付きカルマンフィルタリングにおいて数学的に同等となる条件は何か？
• RQ2 実装上、2つの手法の計算コストとメモリ要件はどのように比較できるか？
• RQ3 特に誤差共分散行列の対称性や正定値性の喪失を伴う数値的安定性への影響は何か？
• RQ4 局所線形化を用いることで、制約付きカルマンフィルタフレームワークを非線形制約に拡張できるか？
• RQ5 等式制約を強制することは、非制約付きフィルタリングと比較して誤差共分散構造にどのように影響を与えるか？

主な発見

• イノベーション共分散とシュール補行列が非特異であるという条件下で、測定値拡張法と射影ベース推定法は、数学的に同一の状態推定値および誤差共分散行列を生成する。
• 射影法は計算がより効率的であり、メモリ消費量が少なく、相互相関項の計算を回避できるため、大規模システムに適している。
• 拡張法は、既存のカルマンフィルタコードベースへの実装が容易であり、アルゴリズムの変更が不要である。また、制約測定値にノイズを追加することでソフト制約への拡張も可能である。
• 等式制約を強制することで、誤差共分散行列の分散が小さくなり、推定プロセスに追加の情報が組み込まれる。
• 丸め誤差による数値的不安定性は懸念事項であり、特に誤差共分散行列の対称性や正定値性の喪失が生じる可能性があるが、ジョゼフ形式を用いることで緩和できる。
• 2つの手法の解析的同等性は、カルマンゲイン、予測誤差共分散、制約行列を含む行列恒等式を用いて証明されており、フレームワークの堅牢性が確認されている。