  ѧ 
JOURNAL OF ASTRONAUTICS
19984  19  2ڿƼڿ

ĽƹKALMAN˲
ڵƵеӦ*
 ݶ
(廪ѧԶϵ**100084)
 
(ҵѧѧԺ**150001)
ժ  ҪоĽƹKalman˲(MEKF)ӦڵƵ
⡣ΪϵͳĿɹԣǲһ˫ָŵɡ
ϵͳ״̬ľֵϸߣСôMEKFĹƾ
ƹKalman˲(EKF)

ʡƹKalman˲  ĽƹKalman˲   Ƶ  
˫ָ굼



APPLICATION OF MODIFIED EXTENDED KALMAN
FILTER TO PASSIVE MISSILE GUIDANCE
Zhou Di
(Department of Automation,Tsinghua UniversityBeijing
*100084)
Hu Hengzhang Yang XuDong
(Aerospace School,Harbin Institute of Technology*Harbin
*150001)
Abstract  A modified extended Kalman filter(MEKF)is proposed and applied to passive 
missile guidance.We adopt a dual control method to design guidance law for enhancing the 
observability content of the control system.Simulation results indicate that if the expectation 
of the system state is relatively large and the wave of the state is relatively minor,the 
performance of the MEKF is much better than that of the extended Kalman filter(EKF).

Key words Extended kalman filter  Modified extended kalman filter   Passive missile 
guidance  Dual control guidance law

1  

űڸٺƵеĹ㷺ӦãڽнǶȲ
¶Ŀ״̬йǵŨȤнǶȲĵ
ƵֳƱƵ⡣ѧϽֱϵһ
̬ģͺһԹ۲ģһ⣬Ҳڼϵһ
Զ̬ģͺһԹ۲ģ1ݡڱƵ£
Ļй켣˲ֱܲӰ2ݡ3ݣ
ƵʱбҪϵͳɹָꡣ

Ƶгõķ˲ƹKalman˲(EKF)Ȼ
ֻеϵͳĶ̬ģͺ͹۲ģͶܽӽʱEKFĹƽ
ܽӽֵһָĽƹKalman˲4(MEKF)Կ˷һ
ԼڵƵӦMEKFĿ״̬ơ

2  ֱϵбƵ

ͼ1 Ŀ˶ϵڷʱĿ궼ʵʾ(
ͼ1)ĿٶһGauss-Markovϵͳ̬ģ
Ϊ
dX=AXdt+bdt+wdt
(1)
X=x y z vx vy vz aTx aTy aTzTǰĿ뵼֮
λãмٶȣĿٶȣb=
0 0 0 -aMx -aMy -aMz 0 0 0TǿaMxaMyaMzٶȣ
w=0 0 0 0 0 0 wTx wTy wTzT⣬



ϵͳ۲ģΪ
dY=h(x)dt+vdt
(2)
h(x)=tan-1y/x  tan-1-z/(x2+y2)1/2Tv۲
wvǾֵΪĸ˹ɫwv໥

3  ˫ָ굼

    ϵͳ(1)(2)ӦȷϵͳΪ


ԶͿƷУҪ΢ַԼ(3)ʼԼt0x0,y0,z0,vx0,vy0,vz0,aTx0,aTy0,aTz0ԼնԼtfǰ£
aMxaMyaMzʹָСxf,yf,zfնѰ
(5)
˫ָƷУҪָ(5)Ļϼϵͳ(3)(4)
Ŀɹָ꣬ǶһָΪ

(6)
Ц(t,t0)=Axתƾ󣬼


t=t-t0,H=? h/?xT,SNԽǼȨtrʾļ



s1,s2,s3ǷǸʱ


q1=(x2+y)(x2+y2+z2)/2(x2+y2+z2)ݡþ󼣵ʣ(6)ʽ
д

(7)
H,N,S(7)ʽɵ

(8)
ֻλϢʱs1=1,s2=s3=0,(8)ʽΪ

(9)
ۺ(5)(9)ʽ˫ָΪ

(10)
csǴĳ

    ˫ֱָϵxyz⣬
ֻ迼aMyʹԼ=Vy,y=aTy-aMy,Ty=-aTyԼt0,y0,vy0,aTy0tf
£ָ

(11)
С

    Ӧſۿ
aMy=c1y+c2vy+c3aTy
(12)

c1=2111+2221+2331
c2=2112+2222+2332
c3=2113+2223+2333

󦫺ͦĶͽⷨϷﲻ
߿ɲף3еĸ¼4  ĽƹKalman˲(MEKF)

    Ƿϵͳ
dX=f(t,X)dt+Budt+1(t)dw,X(0)=X0,t0
(13)
dY=h(t,X)dt+20(t)dv,Y0=0,t0
(14)
״̬XRn۲YRmuRlwv໥Ĳ
˶ǵάֱn1m112ǴĳBnl
(t)nn1󣬦0(t)mm1h0,)RnRm,f0,)RnRn,
X0Lɲ޵ĶξҶwv

    TaylorΧֵX^չɵEKF

(15)

(16)
A(t,X)H(t,X)HessianfXhX

    ֻеfhܽӽʱ(15)(16)Ľӽֵ
Ϊ˿˷һԼǽfhΧ֪ԻΧƱ
ԻɵһָĽƹKalman˲(MEKF)

    Ϊȷ΢ַ
d=f(t,)dt+Budt,0=EX0
(17)
Ľ⣬XΪ΢ַ
dX=f(t,X)dt+Budt+1(t)dw,X(0)=X0
(18)
ʵ⡣X~ΪΧȷX-ĲӶX=-+X~fhΧƽ
TaylorչƳMEKF̣X-(17)ʽľȷ⡣

    A(t,)=fX-,H(t,)=hX-ô
f(t,)=f(t,-)+A(t,)X~+0(X~)
(19)
h(t,)=h(t,)+H(t,)X~+0(X~)
(20)
(19)(20)ʽ(13)(14)ʽɵòĶ̬̺͹۲ⷽ
dX~=A(t,)X~dt+1(t)dw,X~0=0
(21)
dY=h(t,)+H(t,)X~dt+20(t)dv,Y(0)=0
(22)
˲ⱻ⡣һɳֵ(17)
ȷ⣻ڶɲ(21)(22)ȷ
⡣Ȼ֪X-(21)(22)ԵģX~YǸ˹
̡X~СƫΪ^=E{X~/Yt}ЭΪP=E{(X
~-^)(X~-^)T/Yt}Ytֱtʱ,YСҡӦ
ϵͳKalman-Bucyۣģ(21)(22)ŹΪ

ʼΪ^0=0,P(0)=0X~ЭP(t)XЭͬ
MEKFУ(17)(21)(22)ɵùֵX^=X-+X~

5  MEKFڵƵеӦ

    MEKFУԻĲοһȷֵںܶ£ȷ
ֵ͵״̬ľֵɴ˿֪ϵͳ״ֵ̬ϸߣСô
ַõĹֵܾ൱ߵľȡϵͳдȷ
书ԶʱڱƵУϵͳ
ȷbǵļٶĹԶϵͳеwĹ
ʡ⣬ϵͳĶ̬ģ(1)ʽԵģֵ׼ȷʱ
ȷ⡣ԭڱƵӦMEKFȻɵø߾ȵ״̬
ֵΪ֤һ㣬ǰEKFMEKFͬʱӦڱƵ⣬
зо

    ʱϵͳʼ״̬Ϊx0=3500m,y0=1500mz0=1000mvx0=-1
100m/svy0=-150m/s,vZ0=-50m/s,aTx0=aTy0=aTz0=0m/s2EKFMEKFʼ
ľֵ趨Ϊ㣬ʼP(0)=0ϵͳ̬ǿȦ1=1m/s2
ǿȦ2=10-350Monte-Carloõ˲ͳ
ͼ1ͼ3ʾͼ1УĳһʱtԾùʽ


ãEexݴxĹľֵͬٶȹľ
ͳƽEevԼĿٶȹľͳƽ
Eeaݡͼ13еķMEKFĹƾԸEKF


ͼ2 Ծ
ͼ3 ٶȹ
ͼ4 ٶȹ
6  

    ڵƵвøĽƹKalman˲(MEKF)
ΪϵͳĿɹԣһ˫ָŵɡ
MEKFľԸƹKalman˲(EKF)


19951218յ

*ĵõҽίʿ

ο
1  Balakrishnan S N.Extention to Modified Polar Coordinates and Application with 
Passive Measurements.Journal of Guidance,Control,and Dynamics,1989,12(6):906-912
2  Nardone S C,Aidala V J.Observability Criteria for Bearing-only Target Motion 
Analysis.IEEE Transactions on Aerospace and Electronic Systems,1981,AES-17(2):162-166
3  Hull D G,Speyer J L,Burris D B.Linear Quadratic Guidance Law for Dual Control of 
Homing Missiles.Journal of Guidance,Control and Dynamics,1990,13(1):137-144
4  Ahmed N U,Radaideh S M.Modified Extended Kalman Filtering.IEEE Transactions 
on Automatic Control 1994,39(6):1322-1326
5  Song T L,Speyer J L.A Stochastic Analysis of Modified Gain Extended Kalman Filter 
with Applications to Estimation with Bearings Only Measutements.IEEE Transactions on 
Automatic Control,1985,AC-30(10):940-949
