《カルマンフィルター》 - 版の履歴

2007年8月6日 (月) 18:03にKuwashimaによる

2007-08-06T18:03:11Z

2007年7月25日 (水) 03:54にOrsjwikiによる

2007-07-25T03:54:12Z

Orsjwiki: "《カルマンフィルター》" を保護しました。 [edit=sysop:move=sysop]

2007-07-19T13:42:50Z

"《カルマンフィルター》" を保護しました。 [edit=sysop:move=sysop]

2007年7月18日 (水) 08:25に122.17.2.240による

2007-07-18T08:25:40Z

2007年7月18日 (水) 07:08にOrsjwikiによる

2007-07-18T07:08:32Z

2007年7月17日 (火) 02:44に122.17.2.240による

2007-07-17T02:44:11Z

2007年7月12日 (木) 10:11に122.17.2.240による

2007-07-12T10:11:18Z

2007年7月11日 (水) 04:25に122.17.2.240による

2007-07-11T04:25:43Z

差分を表示

122.26.167.76: 新しいページ: '【かるまんふぃるたー (Kalman filter) 】 \begin{figure}[hbt] \begin{center} \unitlength=10pt \begin{picture}(23,7.6)(0,0) \put(0.5,4){\vector(1,0){3}} % 2.0 \put(1....'

2007-07-07T18:28:59Z

新しいページ: '【かるまんふぃるたー (Kalman filter) 】 \begin{figure}[hbt] \begin{center} \unitlength=10pt \begin{picture}(23,7.6)(0,0) \put(0.5,4){\vector(1,0){3}} % 2.0 \put(1....'

新規ページ

【かるまんふぃるたー (Kalman filter) 】

\begin{figure}[hbt]
\begin{center}
\unitlength=10pt
\begin{picture}(23,7.6)(0,0)
\put(0.5,4){\vector(1,0){3}} % 2.0
\put(1.3,4.5){\makebox(0,0)[b]{$w_t$}}
\put(3.5,3){\framebox(3,2){$B$}} % 4.0
\put(6.5,4){\vector(1,0){1.7}} % 1.2
\put(7.5,4.6){\makebox(0,0){\scriptsize $+$}}
\put(8.5,4){\circle{0.6}} %8.5
\put(8.8,4){\vector(1,0){2.2}}
\put(9.8,4.7){\makebox(0,0)[b]{$x_{t+1}$}}
\put(11,3){\framebox(3,2){$z^{-1}$}}
\put(14,4){\vector(1,0){3}}
\put(15.5,4.5){\makebox(0,0)[b]{$x_t$}}
\put(15.5,4){\circle*{0.1}}
\put(17,3){\framebox(3,2){$C$}}
\put(20,4){\vector(1,0){2.2}}
\put(21.5,4.6){\makebox(0,0){\scriptsize $+$}}
\put(22.5,4){\circle{0.6}}
\put(22.8,4){\vector(1,0){3}}
\put(25,4.5){\makebox(0,0)[b]{$y_t$}}
\put(15.5,4){\line(0,-1){4}}
\put(15.5,0){\vector(-1,0){1.5}}
\put(11,-1){\framebox(3,2){$A$}}
\put(11,0){\line(-1,0){2.5}}
\put(8.5,0){\vector(0,1){3.7}}
\put(7.9,3){\makebox(0,0){$ \scriptstyle + $}}
\put(22.5,6.8){\vector(0,-1){2.5}}
\put(23,5){\makebox(0,0){$ \scriptstyle + $}}
\put(23.5,6.5){\makebox(0,0){$v_t$}}
\put(21,0){\makebox(0,0)[b]{$z^{-1}$: {\scriptsize 遅れ作用素}}}
\end{picture}
\end{center}
\caption{状態空間モデル} \label{B-H-05+KALMAN1}
\end{figure}

　図1に示すガウス白色雑音を受ける離散時間線形確率システムを考える.

\begin{eqnarray}
x_{t+1}&=&Ax_t+Bw_t \label{B-H-05+1}\\
y_t&=& Cx_t+v_t,\ t=0, 1, \cdots \label{B-H-05+2}
\end{eqnarray}

ただし, $x_t$は$n$次元状態ベクトル, $y_t$は$p$次元観測ベクトル,$w_t$, $v_t$は$m$および$p$次元ガウス白色雑音ベクトルで, 平均値は0, 共分散行列は

E\{w_tw_s^{\top}\}=Q\delta_{ts}, \ \ E\{v_tv_s^{\top}\}=R\delta_{ts}, \ \ E\{w_tv_s^{\top}\}=0

であるとする. ただし, $Q$, $R$は非負定値対称行列, $\delta_{ts}$はクロネッカーの記号である. $A,\:B,\:C,\:Q,\:R$は一般に時間の関数であってもよいが,簡単のために添字$t$は省略している. また初期値$x_0$は平均値$\bar{x}_0$,共分散行列$\Sigma_0$のガウス確率ベクトルであり, 雑音とは無相関であるとする.

　カルマンフィルタは, 観測データ$Y_{0}^{\top}:=\{y_0, y_1, \cdots, y_t\}$に基づいて,状態$x_{t+m}$の最小分散推定値(すなわち$x_{t+m}$の条件付き期待値)

\hat{x}_{t+m|t}=E\{x_{t+m}|Y_{0}^{\top}\}, \ t=0, 1, \cdots

を逐次的に計算するアルゴリズムである. $m>0$, $m=0$, $m<0$にしたがってそれぞれ, 予測, 濾波, 平滑という.以下では, 状態ベクトルの予測推定値, 濾波推定値を$\hat{x}_{t/t-1}$, $\hat{x}_{t/t}$と表し, それぞれの推定誤差共分散行列を次のようにおく.

P_{t/t-1}=E\{[x_t-\hat{x}_{t/t-1}][x_t-\hat{x}_{t/t-1}]^{\top}\}, \quad
P_{t/t}=E\{[x_t-\hat{x}_{t/t}][x_t-\hat{x}_{t/t}]^{\top}\}

　1960-61年にカルマン(R. E. Kalman)とビュシー(R. S. Bucy)は式(1), (2)の状態空間モデルに対して, カルマンフィルターと呼ばれる以下のようなアルゴリズムを提案した [1, 2, 3, 4, 5, 6].

(i) フィルタ方程式

\begin{eqnarray}
\hat{x}_{t+1/t}&=&A\hat{x}_{t/t}, \quad \hat{x}_0=\bar{x}_0
\label{B-H-05+3} \\
\hat{x}_{t/t}&=&\hat{x}_{t/t-1}+K_t[y_t-C\hat{x}_{t/t-1}]
\label{B-H-05+4}
\end{eqnarray}

(ii) カルマンゲイン

\begin{equation}
K_t=P_{t/t-1}C^{\top}[CP_{t/t-1}C^{\top}+R]^{-1} \label{B-H-05+5}
\end{equation}

(iii) 推定誤差共分散行列

\begin{eqnarray}
P_{t+1/t}&=&AP_{t/t}A^{\top} + BQB^{\top}
\label{B-H-05+6}\\
P_{t/t}&=&P_{t/t-1}-P_{t/t-1}C^{\top}[CP_{t/t-1}C^{\top}+R]^{-1}CP_{t/t-1},
\quad P_{0/-1}=\Sigma_0
\label{B-H-05+7}
\end{eqnarray}

\begin{figure}[hbt]
\begin{center}
\unitlength=10pt
\begin{picture}(23,7.6)(0,0)
\put(0,4){\vector(1,0){2.5}}
\put(0.5,4.5){\makebox(0,0)[b]{$y_t$}}
\put(2,4.6){\makebox(0,0){$ \scriptstyle + $}}
\put(4,4.4){\makebox(0,0)[b]{$\nu_t$}}
\put(2.8,4){\circle{0.6}}
\put(2.8,0){\vector(0,1){3.7}}
\put(2.2,3.1){\makebox(0,0){$ \scriptstyle - $}}
\put(3.1,4){\vector(1,0){2.3}}
\put(5.4,3){\framebox(3,2){$K_t$}}
\put(8.4,4){\vector(1,0){2.1}}
\put(10.0,4.6){\makebox(0,0){$ \scriptstyle + $}}
\put(10.8,4){\circle{0.6}}
\put(12.5,4.5){\makebox(0,0)[b]{$\hat{x}_{t/t}$}}
\put(11.2,4){\vector(1,0){2.6}}
\put(13.8,3){\framebox(3,2){$z^{-1}$}}
\put(16.8,4){\vector(1,0){5}}
\put(19.5,4.5){\makebox(0,0)[b]{$\hat{x}_{t-1/t-1}$}}
\put(19.6,4){\circle*{0.1}}
\put(19.6,4){\line(0,-1){4}}
\put(19.6,0){\vector(-1,0){2.8}}
\put(13.8,-1){\framebox(3,2){$A$}}
\put(10.8,0){\circle*{0.1}}
\put(10.8,0){\vector(0,1){3.7}}
\put(10,3.1){\makebox(0,0){$ \scriptstyle + $}}
\put(5.4,-1){\framebox(3,2){$C$}}
\put(2.8,0){\line(1,0){2.6}}
\put(13.8,0){\vector(-1,0){5.4}}
\put(12,-1){\makebox(0,0)[b]{$\hat{x}_{t/t-1}$}}
\end{picture}
\end{center}
\caption{カルマンフィルターのブロック線図} \label{B-H-05+KALMAN2}
\end{figure}

　図2にカルマンフィルタのブロック線図を示す.カルマンフィルタは観測値$y_t$を入力とし, 推定値$\hat{x}_{t/t-1}$, $\hat{x}_{t/t}$を逐次的に出力する線形動的システムであり,$\nu_t=y_t-C\hat{x}_{t/t-1}$はイノベーションと呼ばれている.

　$w_t,\:v_t,\:x_0$がガウス分布でない場合には, 上のアルゴリズムは状態ベクトルおよび信号の線形最小分散推定値を与えるという意味で, 最適なフィルタである.

　式(6), (7)から$P_{t/t}$を消去して,$P_t:=P_{t/t-1}$とおくと, 離散時間リッカチ方程式

\begin{equation}
P_{t+1}=A(P_{t}-P_{t}C^{\top}[CP_{t}C^{\top}+R]^{-1}CP_{t})A^{\top} + BQB^{\top}
\label{B-H-05+8}
\end{equation}

を得る. また上式の$t\to \infty$における極限を代数リッカチ方程式という. 制御理論の分野には(代数)リッカチ方程式に関する膨大な研究がある [7].

　白色雑音を受ける非線形確率システムに対しても,その線形化モデルにカルマンフィルタを適用することができるので, カルマンフィルタは航空宇宙工学の分野において飛翔体の軌道推定に威力を発揮した. また状態ベクトルだけてなく, モデルに含まれる未知パラメータを同時に推定する拡張カルマンフィルタも提案されており, カルマンフィルタの応用は時系列の推定を始めとして非常に多くの分野に見られる.

----

'''参考文献'''

[1] R. E. Kalman, "A New Approach to Linear Filtering and Prediction Problem," ''Transactions of American Society of Mechanical Engineers, Journal of Basic Engineering'', '''82D''' (1960), 34-45.

[2] R. E. Kalman and R. S. Bucy, "New Results in Linear Filtering and Prediction Theory," ''Transactions of American Society of Mechanical Engineers, Journal of Basic Engineering'', '''83D''' (1961), 95-108.

[3] B. D. O. Anderson and J. B. Moore, ''Optimal Filtering'', Prentice-Hall, 1979.

[4] M. S. Grewal and A. P. Andrews, ''Kalman Filtering - Theory and Practice'', Prentice-Hall, 1993.

[5] 有本卓, 『カルマンフィルター』, 産業図書, 1977.

[6] 片山徹, 『新版応用カルマンフィルタ』, 朝倉書店, 2000.

[7] S. Bittanti, A. J. Laub and J. C. Willems (Eds.), ''The Riccati Equation'', Springer, 1991.

← 古い版		2007年8月6日 (月) 18:03時点における版
148行目:		148行目:

	[7] S. Bittanti, A. J. Laub and J. C. Willems (Eds.), ''The Riccati Equation'', Springer, 1991.		[7] S. Bittanti, A. J. Laub and J. C. Willems (Eds.), ''The Riccati Equation'', Springer, 1991.
		+
		+	[[category:予測\|かるまんふぃるたー]]

@@ 1行目: / 1行目: @@
 '''【かるまんふぃるたー (Kalman filter)】'''
-<center><table><tr><td align=center>[[画像:sk-0098-b-h-05-1.png]]</td></tr>
+<center>
-<td align=center>図１：状態空間モデル<br><br>[[スタイル検討#カルマンフィルター (0098-b-h-05-1)|スタイル検討]]</td></table></center>
+<table>
 <!--
@@ 92行目: / 98行目: @@
-<center><table><tr><td align=center>[[画像:sk-0098-b-h-05-2.png]]</td></tr>
+<center>
-<td align=center>図２：カルマンフィルターのブロック線図<br><br>[[スタイル検討#カルマンフィルター (0098-b-h-05-2)|スタイル検討]]</td></table></center>
+<table>
 <!--

@@ 4行目: / 4行目: @@
 <td align=center>図１：状態空間モデル<br><br>[[スタイル検討#カルマンフィルター (0098-b-h-05-1)|スタイル検討]]</td></table></center>
@@ 91行目: / 94行目: @@
 <center><table><tr><td align=center>[[画像:sk-0098-b-h-05-2.png]]</td></tr>
 <td align=center>図２：カルマンフィルターのブロック線図<br><br>[[スタイル検討#カルマンフィルター (0098-b-h-05-2)|スタイル検討]]</td></table></center>

@@ 1行目: / 1行目: @@
 '''【かるまんふぃるたー (Kalman filter)】'''
-<center><table><tr><td align=center>[[スタイル検討#カルマンフィルター (0098-b-h-05-1)|スタイル検討]]</td></tr>
+<center><table><tr><td align=center>[[画像:sk-0098-b-h-05-1.png]]</td></tr>
-<td align=center>図１：状態空間モデル</td></table></center>
+<td align=center>図１：状態空間モデル<br><br>[[スタイル検討#カルマンフィルター (0098-b-h-05-1)|スタイル検討]]</td></table></center>
@@ 89行目: / 89行目: @@
+<center><table><tr><td align=center>[[画像:sk-0098-b-h-05-2.png]]</td></tr>
-<center><table><tr><td align=center>[[スタイル検討#カルマンフィルター (0098-b-h-05-2)|スタイル検討]]</td></tr>
+<td align=center>図２：カルマンフィルターのブロック線図<br><br>[[スタイル検討#カルマンフィルター (0098-b-h-05-2)|スタイル検討]]</td></table></center>

@@ 9行目: / 9行目: @@
-:<math>
+<center>
 \begin{array}{rlll}
 x_{t+1} &=& Ax_t+Bw_t & \qquad (1)\\
@@ 15行目: / 16行目: @@
 \end{array}
 \, </math>
@@ 20行目: / 22行目: @@
-:<math>
+<center>
 E \{ w_t w_s^{\top} \} = Q\delta_{ts}, \ \
 E \{ v_t v_s^{\top} \} = R\delta_{ts}, \ \ E\{w_tv_s^{\top}\}=0
 \, </math>
@@ 31行目: / 35行目: @@
-:<math>
+<center>
 \hat{x}_{t+m|t}=E\{x_{t+m}|Y_{0}^{\top}\}, \ t=0, 1, \cdots
 \, </math>
@@ 39行目: / 45行目: @@
-:<math>
+<center>
 P_{t/t-1}=E\{[x_t-\hat{x}_{t/t-1}][x_t-\hat{x}_{t/t-1}]^{\top}\}, \quad
 P_{t/t}=E\{[x_t-\hat{x}_{t/t}][x_t-\hat{x}_{t/t}]^{\top}\}
 \, </math>
@@ 50行目: / 58行目: @@
 (i) フィルタ方程式
-:<math>
+<center>
 \begin{array}{rlll}
 \hat{x}_{t+1/t}&=&A\hat{x}_{t/t}, \quad \hat{x}_0=\bar{x}_0  & \qquad (3)\\
@@ 56行目: / 65行目: @@
 \end{array}
 \, </math>
+</center>
 (ii) カルマンゲイン
-:<math>
+<center>
 K_t=P_{t/t-1}C^{\top}[CP_{t/t-1}C^{\top}+R]^{-1}   \qquad (5)
 \, </math>
 (iii) 推定誤差共分散行列
-:<math>
+<center>
 \begin{array}{rlll}
 P_{t+1/t} &=& AP_{t/t}A^{\top} + BQB^{\top}  & \qquad (6)\\
@@ 74行目: / 86行目: @@
 \end{array}
 \, </math>
@@ 89行目: / 102行目: @@
-:<math>
+<center>
 P_{t+1}=A(P_{t}-P_{t}C^{\top}[CP_{t}C^{\top}+R]^{-1}CP_{t})A^{\top} + BQB^{\top} \qquad (8)
 \, </math>

← 古い版	2007年7月19日 (木) 13:42時点における版
(相違点なし)