6. ❖
❖
X0
P0
Xk-1
Pk-1
Xk
p = A Xk-1 + B uk + wk
Pk
p = A Pk-1 AT + Qk
Yk = C Xk + zk
K = Pk
p H / (H Pk
p HT + R)
Xk = Xk
p + K (Yk - Hkp )
Xk
Pk = ( I - KH ) Pk
p
Xk
Pk
|
k-1
|
k
k -> k-1
( )
uk :
wk :
Qk :
Yk :
zk :
K :
R :
X :
P :
G(X, P)
7. ❖ Michel van Biezen (Raytheon)
❖ https://www.youtube.com/playlist?list=PLX2gX-
ftPVXU3oUFNATxGXY90AULiqnWT
❖ 27