ѧ
JOURNAL OF ASTRONAUTICS 
1999ꡡ204ڡvol20No.41999




ϵͳں

ժҪӦýʱͷԻعۣо˵ϵͳͳԲϹ⣬˸ĸ߾ȹơ۷ͷģ׼ȷƷȸߣӦñķߵ
ʡ١ںϡάʱСԻع
DATA FUSING TO TRAJECTORY TRACKING SYSTEM
Wang Zhengming
(Department of Mathematics National University of Defense Technology . Changsha . 410073)
AbstractIn this paper,modern time series method,spline function and nonlinear regression are used,the estimation problem of trajectory parameters associated with range finding system errors and the statistic characteristic parameters of random errors are thoroughly investigated,the high accuracy estimators of above parameters are finally presented.Theoretical analysis and simulation calculations clearly show that the model is accuracy,the parameter estimation methods in question possess high accuracy,applying the methods can improving the quantity of observation data.
Key wordsTrajectory tracking Data fusing Multidimensional time series Spline Nonlinear regression
1
ѡͬվַװ豸Ծ͡͵ı仯ʡı仯ʵȽвϽһԪؾȷ(x,y,z,,,)12ݡڸ߾ҪĳϣҪݵϵͳ£ֻԪǲģͨҪĲԪأ2-4ݡγַӺÿһԪصã߹ĹƾȣǱĹĵ⡣
ִʱ5ݽ͡͵ı仯ʡı仯ʵʱģͣͬʱоͬľ֮䡢ͬľͱ仯֮估ͬľ仯֮ԣòȾڵBʾڷϣӦάԻعоϵͳͳԲĹ⡣
ģͣ١ģСܸĸ߾ȹơ
2ѧģ
t1,t2,,tmʱ̵ĵݵں⡣۲һǵʱģti+1-ti=0.05s(i=1,2,,m-1)һ鲻Ⱦڵֻ
:T1T5=t1TN+2=tmTN+2TN+4
ѡȡڵTi(i=1,2,,N+4)ʱҪע⣺
()̫󣬸ǵľ飬ڵһֱȡh=3,5,8ңh̫СЧؼٲh̫ܱ֤ƽȡ
()ʱt1,tmеĵȻڵӦ{T5,T6,,TN+2}С
Ǧj(t)Ϊ(Tj,Tj+1,Tj+2,Tj+3,Tj+4)ΪڵBƽ2ݼϹڷֻļ裬ԱʾΪBϡ
(1)
ʹ(1)ʽʾѹt1,t2tmʱ̵6mΪb=(bx1,,bxN,by1,,byN,bz1,,bzN)TȼС
3ݵѧģ
3.1ԪģͼͬԪعϵ
ڵӲ豸һβʱڣԪƽ̬0ֵAR(2)д2ݡ༴e(ti)=1e(ti-1)+2e(ti-2)+(ti);{(ti)}0ֵƽ̬У1,2ΪƽڲͬĲԪͬһԪͬʱΣAR(2)еĲ12Ҧǲͬġ
ҪرָһϽ2žǲķȷĲ豸ԣ2ſΪ֪ġ
ǰᵽֲԪУͬ͵ĲԪصԲصġͬԪ豸ͬҲǲصġ
ͲһվվõĶ͵ݿ϶صġͱ仯ҲGPSĲеĶͬ⣬Ϊ͵ݶǾĿϵGPSתõġ
仯ͨģҲصΪͬĲվĿľվͬһվľ֮ı仯صġ
3.2ݵѧģ
Ҫо״ģͣtiʱ̵Ĺ۲ݿԱΪ
(2)
(3)
(4)
SΪÿһһͣΪSݣaSΪĳֵϵͳͬ*ΪÿһֱΪͱ仯ʼ仯ʡ
{S(ti)}mi=1,{*(ti)}mi=1,{p(ti)}mi=10ֵ̬ƽȰУ
S(ti)i.i.dN(0,QS),*(ti)i.i.dN(0,Q*),P(ti)i.i.dN(0,QP)(5)
Ҫָ*SҪóɶӦϵվվַǲһġ
Ϊⷽ㣬ǿǲԪȷ蹲3һվͬĽվõľͲԪ*513ɵһվõľͱ仯ʣ4ɵڶվõľͱ仯ʣ5ɵվõľͱ仯ʡ*2һվõQSQPQΪ¾
(6)
ײ豸ص㣬ÿԪΪƽ̬0ֵAR(2)УA1A23׶ԽǾB1B25׶ԽǾC1C22׶ԽǾ󡣼
A1=diag(a(1)1,a(1)2,a(1)3),A2=diag(a(2)1,a(2)2,a(2)3)
B1=diag(b(1)1,b(1)2,b(1)3,b(1)4,b(1)5),B2=diag(b(2)1,b(2)2,b(2)3,b(2)4,b(2)5)
C1=diag(c(1)1,c(1)2),C2=diag(c(2)1,c(2)2)
4
4.1ʱвĹ
(x,y,z,,,)ԱʾΪ(1)ʽʽһͲԪҲԱʾ(S1(t)Ϊ)ʽ6ݡ
X=(xij)mN=(j(ti))mN=(XT1,XT2,,XTm)T,=(1,2,,N)T(7)
ô(2)(5)(6)ʽע⵽A1A2ΪԽǾУ
(ti)=Xi+a(1)1(ti-1)-Xi-1£+a(2)1(ti-2)-Xi-2£+S1(ti)(8)
Ӧ(8)ʽķԻعģͣԸa(1)1,a(2)1,qS11µĹơ
Ϊ˳(ti)ĲƽȵAR(2)еص㣬֤a(1)1,a(2)1ƽԵҪ£һµİ취ע⵽κʵ1,2ʵ,ǾֵС1
(9)
(9)ʽ֪ģ(8)Ըдµķģͣ
(10)
ɻعģ(10)Ը(1,2,,N,1,2)Ĺơ
ڶκ(-,+)ϸ񵥵ģ12Ĺa(1)1,a(2)1Ĺ1-1ӦġӦڦ1ͦ2ֱֵȡ19ԭõʱҪ0ͬʱΪ1ͦ2ĳֵΪأҪòͬĦֵɦºͦ12Ĺƿɵ(12N,a(1)1,a(2)1)Ĺֵ(1,2,,N,(1)1,(2)1)
RS1(ti)=(ti)-Xi-(1)1(ti-1)-Xi-1-(2)1(ti-2)-Xi-2
ɸqS11Ĺơ
23ʹԸa(1)j,a(2)j,qSjj(j=2,3)Ĺƣͬʱ{RSj(ti)}mi=3(j=2,3)

ۺǾ͵õ˾A1A2QSĹơ
ھͱ仯ʡ仯ҲͬǿͨԪѧģ͵õȫʱвĹơ
4.2ʱʱвĹ
У״ݿƽȵAR(2)УʵֻǲһֽҪԭķƵǷƽȵġ
ǰt1,t2,,tmʱ̵ݷΪɸʱ(5)ÿβ3롣༴ǰѣT5,TN+2ݷֳɣT5,T6ݣT6,T7ݣTN+1,TN+2ݹN-3С俼ǡ1(t)ΪÿһСϽS1(t)+a1ζʽ
S1(t)+a1=g1+g2t+g3t2+g4t3,T5tT6
t1=T5,tl=T6
(11)
ģ(10)ǿɵõ
(12)
ʹ4.1ķԸеʱвAi,Bi,Ci(i=1,2),QS,Q*,QPĹơͬɵʱвڣTj,Tj+1(j=6,7,,N+1)Ĺơ
ȻķƵʱ仯ʱͬʱAi,Bi,Ci(i=1,2),QS,Q*,QPֵһa(1)1Ϊǿ԰a(1)1ʱtĶζʽ
a(1)1(t)=d1+d2t+d3t2(13)
(1)1,jֱTj+4,Tj+5(j=1,2,,N-3)a(1)1Ĺֵô
(14)
ģ(14)ʽɵõ(13)ʽd1,d2,d3Ĺơ
(1)1(t)=1+2t+3t2,T5tTN+2
ͬǿԵõÿʱʱĹơʱؿΪʱtĺ
4.3볣ֵϵͳĹ
ʱвĹƣΪƵͳֵ
(5)(6)(7)ɵãi=3,4,,mʱ
(15)
(16)
(17)
i=1,2ʱ
(ti)=S(ti)+a+eS(ti),*(ti)=*(ti)+e*(ti),(ti)=(ti)+eP(ti)
ΪAi(t),Bi(t),Ci(t)(i=1,2)QS(t),Q*(t),QP(t)ڣt1,t2ȡֵ
(18)
KSΪKS,K*,KPļ㷽
DS=(dij)33,WS=(wij)33ע⵽
eS(ti)=A1eS(ti-1)+A2eS(ti-1)+(ti)(19)
WTS=A1DS+A2WSע⵽A1A2DSΪԽǾ󣬶ȶA2ĶԽԪľֵС1
(20)
D=QS+A1DA1+A2DA2+A2WTSA1+A1WSA2(21)
(20)ʽ(21)ʽɵã

ɴ˿ɵþDS(20)ʽɵWSǵõKSӶ
(22)
(23)
(24)
ע⵽tiȷS(ti),*(ti),(ti)ǲb֪(1517)ʽ(2224)ʽз͵õһڵϵbͲೣֵϵͳaķԻع鷽
Y=F()+,ǡN(0,I)(25)
÷Իع5ݣɵõ=(aT,bT)TĹ(ƪֵ)
ֻ״ϵͳҲԿ״ѧGPSϵͳ
*Ȼѧ(No.69872039)͹863Ŀ
ߵλƼѧѧϵ . ɳ . 410073
ο
1Ž𻱣.Զ̻ľȷ.ɳƼѧ磬19956
2׶.ݽģ.ɳƼѧ磬19967
3׶.㺽һ·㷨.ѧ199617(2)81-84
4.״ﳣֵϵͳĹ.йռѧ1996(1)1-9
5һ.ִʱзӦ.֪ʶ磬19896
6ܺ.뼰仯ʸݵѧ.йռѧ1994(3)17-24
7ܺ.ƵϵͳƵ·.йѧ(E)1998(2)160-167
ո:1998212
޻:1999426
