Kalmanフィルタの状態推定

観測ノイズのある線形離散系で、逐次的に状態と推定誤差共分散を求める。

各行は等間隔の離散ステップです。行列A・H・Q・Rは全ステップで一定とし、x₀・P₀をステップ0の値としてステップ1から予測します。

Q・P₀は半正定値、Rは正定値が必要です。雑音の相互相関は0と仮定し、単位は行列間で整合させてください。

入力すると自動で計算します。Enterで次の項目へ進めます。次の入力欄を選んで進めます。

選択内容に応じて、残りの入力項目を案内します。

計算する内容

状態量の単位の2乗。Qは0以上。

観測量の単位の2乗。Rは0より大きい値。

観測列(1行=1ステップ)必須
行ステップ k観測 z(欠測可) 任意操作
1

2列を左端の欄へタブ区切りで貼り付けられます。1000行まで。

kは1からの連番。観測がないステップはkだけ入力し、zを空欄にします。


計算結果

必要な値を入力すると自動で計算します。

お気に入り一覧

計算方法・適用範囲・出典

計算方法

状態:xₖ = A xₖ₋₁ + wₖ、観測:zₖ = H xₖ + vₖ。予測 x⁻ₖ = A x̂ₖ₋₁、P⁻ₖ = A Pₖ₋₁ Aᵀ + Q。残差 νₖ = zₖ − H x⁻ₖ、Sₖ = H P⁻ₖ Hᵀ + R、Kₖ = P⁻ₖ Hᵀ Sₖ⁻¹、x̂ₖ = x⁻ₖ + Kₖνₖ。事後共分散はJoseph形式 Pₖ = (I−KₖH)P⁻ₖ(I−KₖH)ᵀ + KₖR Kₖᵀ。欠測成分はH・R・zの対応行列要素を除いた更新、全欠測なら予測のみ。有限ステップの計算であり、定常ゲインやモデルの収束は判定しません。

最終推定状態、事後共分散、予測残差、ステップ別の明細。

計算例(架空の数値)

例:1状態、A=H=1、Q=0、R=1、x₀=0、P₀=1、観測はk=1で1、k=2で3。推定値は順に0.5、1.333333…、事後分散は0.5、0.333333…となります。

適用対象と限界

時不変の線形状態空間モデル。状態1・観測1、または状態2・観測2のモデルで、各ステップのA・H・Q・Rは一定。非線形・連続時間・制御入力・雑音の相互相関・可変サンプリング間隔・平滑化・定常ゲインや収束保証は扱わない。推定は入力モデルの妥当性に依存する。。

方法と出典

方法:離散時間Kalman逐次推定(Joseph形式)v1.0/2026-11-14。データ記録日:2026-11-14。