1 目标运动角速度的引入
(t)=ΦX(t)+w(t)
Y(t)=HX(t)+υ(t)
(s)=(sI-Φ+KH)-1KY(s)
Y(s)=HX(s)+υ(s)
(s)= (s)+ (s)
(s)=(sI-Φ+KH)-1KHX(s)
(s)=(sI-Φ+KH)-1KHυ(s)
= =
H=
2 目标线速度计算
ra= =
× =ra[(sinΔε·ωya-cosΔεcosΔq·ωza)· +(-sinΔε·ωxa+cosΔεsinΔq·ωza)· +(cosΔεcosΔq·ωxa-cosΔεsinΔq·ωya)· ]
Mq= ,Mε=
ωa= =MεMq +Mε
ωa= =
3 引入目标运动速度的自适应交互多模型算法
= + w(t)
= + w(t)
= + υ(t)
(k-1/k-1)= (k-1/k-1)uij(k-1/k-1),j=1,2
P0j(k-1/k-1)=∑uij(k-1/k-1){Pi(k-1/k-1)+
[ (k-1/k-1)- (k-1/k-1)][ (k-1/k-1)- (k-1/k-1)]T} (25)
(k/k-1)=Φj (k-1/k-1)
Pj(k/k-1)=ΦjP0j(k-1/k-1) +Qj (27)
Kj=Pj(k/k-1) (k)
(k/k)= (k/k-1)+Kj(k)[Y(k)-Hj (k/k-1)]
Pj(k/k)=[I-Kj(k)Hj]Pj(k/k-1)
uj(k)= Λi(k) Pijui(k-1)=Λi(k) /c
Sj(k)=HjPj(k/k-1) +R
Λj(k)= exp
(k/k)= (k/k)uj(k) (34)
P(k/k)= uj(k){Pj(k/k)+[ (k/k)- (k/k)][ (k/k)- (k/k)]T}
=
=
=
= + +
= + +
= + +
中国指挥与控制学会会刊 