Professional Documents
Culture Documents
trong
l ma trn thay i trng thi (state transition matrix),
l vector iu
khin,
l ma trn iu khin, cn
l nhiu ngu nhin, vi gi s l n c phn b
Gaussian (phn b normal nhiu chiu)
hip phng sai tng ng.
Ti mi thi im th
trong
, trong
l k hiu ca ma trn
cho kt qu l
l nhiu trong lc o c, v ta gi
.
Nu khng h c nhiu, th ta ch cn t
. Nhng v c nhiu nn khng tnh
c chnh xc
m ch c th ng lng n. Kalman filter l mt hm c lng
quy (recursive estimator) cho php lm vic ny.
Thut ton c lng nh sau: C th chia n thnh 2 bc, bc d on ban u
(predict) v bc iu chnh sau (update)
Predict:
,
y
l k hiu d on gi tr ca
da trn thng tin v gi tr ti thi
im
, cn $\hat{x}_{k|k}$ l c lng gi tr ca
sau khi s dng mi
thng tin ti thi im . Ma trn
dng ch (c lng) ma trn hip phng sai
ca c lng ca .
Update:
lch so vi quan st (measurement residual):
Thng d hip phng sai (residual covariance):
Kalman ti u:
c lng c iu chnh (updated estimate):
Hip phng sai cho c lng mi (updated estimate
covariance):