ѧ 
JOURNAL OF ASTRONAUTICS
1998 19 1 No1 Vol.9 1998Ƽڿ

״Ŀ㷨о
˸ա
(ҵѧ345**150001)
ɡ
(칤ҵܹ˾һԺ14**100076)
ժҪùKalman˲,ͨڱ춫״ֱϵڽӦĿ״̬״۲ⷽ,ĿĻһ׸˹Ʒ,㵽״̬֮,ݻõĴв״ϢĿ굯й,õĽ
ʡĿ١˲ơĿ
THE RESEARCH OF RADAR TRACKING ALGORITHM 
TO REENTRY MANEUVERING TARGET
Cui NaigangLin Xiaohui
(Harbin Institute of Technology*Harbin*150001)
Xi Min
(The 14 institute of the first research institute,CASC*Beijing*100076)
AbstractIn this paper,the state and radar measurement equations of reentry maneuvering target are established in the north-zenith-east coordinate system.The maneuvering model of target is described by a Gauss-Markov process and augmented into the state equations.Then,on the basis of all above,the kalman filter is used to estimate the trajectory of the reentry maneuvering target in terms of the radar measurement information influenced by errors.The simulation results show the effectivity of the method.
Key wordsTarget trackingKalman filterTrajectory estimationReentry maneuvering target
1
Ԥϵͳƺͷչ,״ϢϮĿ,䵯ʵʱ,ݵƽбҪĵԤ,Ϊϵͳȷѽػ,ȷؾṩݡ
׼ȷӰ쵯ԤԵҪءڷǻĿ굯,60ĩѿչо,ҹѧ80࿪չӦо1-3ݡõķһ㶼ӦKalman˲,ͨڲͬϵڽĿ״̬״,ݻõ״ϢϮĿ굯й,⡣
൯Ҫѵδ֪ĵϵ()ԵƾȵӰ졣һ㽫Ϊδ֪㵽״̬֮,ҪƵĿ˶״̬ͬʱ߹ơϵı仯ɲ÷ֶκ״̬ʽԲ,Чġ
ŹԿļӾ,Ϊǿϵͳͻ,Ƚ뵯ͷûʩ,˶ĿĵƸҪ70к,Ӧ 4,ؽС,õķҲKalman˲,ĿԵĿٶΪ״̬,仯ø˹ԲӦоڹڹлδ
ӦùKalman˲,ڱ춫״ֱǲϵڽӦĿ״̬״۲ⷽ,ĿԲʵģ㵽״̬֮,ݻõĴ״ϢԴ(3040g)Ŀĵ˹ơ
ģ͵ѡȡǻĿٵĹؼ,ѡȡԭǼҪлʵ,Ҫѧⲻѧڻģ͵о,Singerģ͡Ʒģ͡Novalͳģ͵ȡҹѧܺҲˡǰͳģ 6ݡģ͵ȱڻʱ䳣ƾԤѡȡ
ĲһƷΪĿĻģ,ѡĻģͺ,ͨ˲ʵ,֤ʵֶԴ(3040g)Ŀ׼ȷĸ١
2˲״̬۲̵ⷽĽ
2.1״̬
Ŀ궯ѧ״̵̬,Ľѧ̽ڱ춫״ֱǲϵO-XYZ֮СԭOȡ״վ,̡߳ȡγȷֱΪh,,B(ͼ1)ģʱ¼:
(a)Ƶת;(b)㶯;(c)ģͲñ׼ģ,ģͲ׼ģ͡
¶ѧʸʽ:
(1)
ЪJֱΪĿٶ,ٶȡϼǣٶȡ,ĿĿٶȡ


ͼ1ϵĶ
ʸ״ֱϵдɷʽ:
X
(2)
еĦѡΪתٶȡܶȼʱ;XYZvXvYvZΪĿ״ϵеλüٶȷ;ROu*ռͼ1бע
ٶȷɱʾΪ:
(3)

(4)
(5)

еĦΪϵ,J2Ϊгϵ
(6)
ϸʽ
(7)
(8)
(9)
u=B-(10)
(11)
(12)
RX=X-ROsin(B-u*-)(13)
RY=Y+ROcos(B-u*-)(14)
еa,bΪģ͵ĳ̰ᡣ
ĿĻԲһƷ,ʽΪ:
(15)
6
ʽе(aX,aY,aZ)T,(ئX,ئY,ئZ)TΪ˹;XYZΪĿʱ䳣,ǵĴСӳĿٶȵı仯,XYZı仯ɼĹ(ئX,ئY,ئZ)TԲ
Ŀλ仯

(17)

(18)

(19)
Լϵı仯
(ئΪֵ˹)
(20)
(17)(20)ʽͬ(2),(15),(16)ʽ㹹13˲״̬,13״̬ΪX,Y,Z,vX,vY,vZ,aJX,aJY,aJZ,X,Y,Z,
2.2״۲ⷽ
״ɲϢĿĸߵͽǦ,λǦǼ״վĿбR,״۲ⷽ:
(21)
(22)
=arctgZ/X+v
(23)
vpvšvΪ,Ӹ˹ֲ
3Թ忨˲㷨
3.1忨˲
ڱ漰ϵͳ״̬۲ⷽ̾ΪԵ,¹忨˲:
(24)
(25)
PK+1/K=K+1/KPK/KTK+1/K+QK(26)
KK+1=PK+1/KHTK+1(HK+1PK+1/KHTK+1+RK+1)-1(27)
(28)
PK+1/K+1=(I-KK+1HK+1)PK+1/K(29)
 

״̬һԤֵ;
K+1/K״̬תƾ;
Iλ;
PK+1/KһԤ;
KK+1˲;
PK+1/K+1˲;
ZK+1Ϣ;
t;
QK;
RK+1۲;
f(*)״̬Ҷ;
h(*)۲ⷽҶ;
Ϣ,ɽ˲㡣
3.2㷨ľʵ
3.2.1FHK+1ȡ
ԱĿ״̬۲ⷽ,FΪ1313ά,HK+1Ϊ313ά,ɸ״̬۲ⷽ,ռƪϴ,ϸд
3.2.2˲ֵѡȡ
ǰ״ݦRi,i,i(i=1,2)ɵĿλ÷
(30)
(31)
(32)
״̬˲ֵȡΪ

ʼ˲õ״̬˲ֵΧѡȡ
3.2.3QKRK+1ѡȡ
״̬һĿ˶ɲȫһ,Ӷ̬Ϊ˲ֲһ,Ҳǿ˷˲ɢһЧ̬QKһͨ˲ڽдģá
RK+1ɸݸ״,3ԭȷQKRK+1ľֵ
4
ݸĳͷĻ,(21)(23)ʽγɴ״ģϢ,ȻɸģϢ״̬۲ⷽ,ͨ忨˲㷨ͷĵ˹ơ˲㷨еQKRK+1ֱȡΪ:
(33)
(34)
˲(Ƶ֮)ͼ2ͼ4


ͼ2˲


ͼ3˲


ͼ4˲
ɷɿ,560580,˲ϴ,ʱ뵯ͷһʱ,֮˲ȶ
5
ĽĿĶѧ̼״,ͨһƷ̼δ֪ĿԼϵı仯ڴ˻ͨ忨˲㷨Ĳʵ˶Դ(3040g)Ŀ굯Ϊ׼ȷĸ١
ο
  1.Ŀ˲.Ƽ.GF38092,1983
  2.Ŀ굯ȷʾо.첿Ƽ,1986
  3֣,ռ.Ӧÿ˲.첿Ƽ,1987
  4C.B.Chang.Application of the Fixed-Interval Smoother to Maneuvering Trjectory Estimation.IEEE TRANSACTIONS ON AUTOMATIC CONTROL,1977,AC-22
  5Ž,ױ.ͳѧ.ɳ:ƴ,1984
  6ܺʵ.Ŀ.:ҵ,1991
