ѧ
JOURNAL OF ASTRONAUTICS
1999 20 3 vol.20 No.3 1999



״ǵ
Ϊ
ժҪ״ǼĻо˵ƽģ͵Ҫ,˶Բǲݴļ㷨,˲㷨,ľ,ѧ쾫ȿɴ100ס
ʡǡKalman˲
AUTONOMOUS ORBIT DETERMINATION WITH 
RADAR ALTITUDE SENSOR
Han Chao Zhang Renwei
(Beijing University of Aeronautics and Astronautics.Beijing.100083)
AbstractThis paper studies a basic method of the autonomous orbit determination with radar altitude and star sensors.With sea level model,a simply method for modifying the influence of earth shape has been presented.Direct and Kalman filter orbit determination methods have been studied.The simulation results show that precision of orbit determination is about 100 meter.
Key wordsSatellite Orbit determination Kalman filter
1
״(Ǹ߶ȼ)ǺǱرЧغ,ڲ溣ϫͲˡǶĻвǡࡢ-Ͳ-ٵȷڲǷ,ͨӦõĲοΪ̫,ǡ̫ͺƽǵȡúƽǲǷӰ춨쾫ȵҪΪѧԵģʹõķĲȽΪ0.08,óΪԳбװ״ǲб,ǵ״Ӱɻø߾(0.004)ĵķ,ͬʱи߶ȵĲֵ,Ǹ߶ȼƺĻϹ۲,Ԥƿɻýϸ߾ȵ졣״ǲоҪ¼:һӰʸ㾫ȴˮ׼(ƽ)ģ͵о;Ǹ߶ȼƺĻϹ۲,ǺƽӰ,ֱӼǵλú̬(ֱӶ취);ֱӶ취Ļ,ĹKalman˲ľ(˲취);󲿷ԺΪģ,ֱӶɴﵽ600׵Ķ쾫,Kalman˲ɴﵽ100׵Ķ쾫ȡ
2ƽģ
ˮ׼ָڵ,ˮλֲγɵ,ף2еķ,õģϵôˮ׼״̡ˮ׼漫ʽķΪ
r0=R(1+Y1+Y2+Y3+)(1)
YiΪӦi׵ϵС,ǵȦ˺͵γȪյĺRΪƽ뾶,YiRֱ
(2)
GMΪ,eΪٶ,WeiΪˮ׼ֵ,aeΪ뾶
n=2,3,(3)
Ϊγ,Ϊ,PmnΪõ¶ʽ,AnmBnmΪϵ,ϵμף3,аn=30m=28ĵϵ
ɵˮ׼ƫԵƽ뾶Ϊ뾶ҪΪJ2ϵӰ졣J2(ĺƽģ)ɺƽ߶Եƽ뾶Ϊ-147,J2ϵԺƽ״ӰԽСģ(1)ĺƽԿģͼĺƽԼΪ-10175ס
3ֱӶ
νֱӶ취Ǹݲֱӽж,岽Ϊ:״ǵĲ͵״ģ,ʸǱϵķ,,ǱԹԿռ̬;ݵʸǱϵķǱԹϵ̬,ڹԿռеλ,ֱӶļ㡣ֱӶļвɶļ,ͬʱɽ̬ļ㡣
ֱӶ취ĹؼΪʸļ㡣ڵ״ǳ,̬λöֱӰ״߷ǵľ(б),ò͵״ģֱӼʸǱϵķ򼸺ܡ״Ϊ,ʸļǵĹ̬޹,ҿֱǵĸ߶ȼǺ͸ǵ˶ڵ״Ϊһ,ƽԵƽ뾶ΪС,ΪС,ǵĹ̬˶й,ǵ˶,˿ø߾ȵĵʸǱϵз
3.1ģеĵʸ
Ϊ,뾶ΪRe,ĺ͵ǱϵΪ(x0,y0,z0)(x,y,z),ģĵķΪ
(x-x0)2+(y-y0)2+(z-z0)2=R2e(4)
״ڵķΪai bi ciT,i=1,2,,m,mΪ״ǵĸ,i״ǵཻ,ҵбΪi,(aii,bii,cii)㷽(4),
(aii-x0)2+(bii-y0)2+(cii-z0)2=R2e(5)
mбĲi(i=1,2,,m)Ϳɵõm(5)ķ,һԷ顣Ҫ(x0,y0,z0),Ҫ3i(5)ɵķΪԷ,ֻܲõ⡣m3,ֻС˽,
(6)
(6)ø˹ţٷ6ݺ,ڷ̵̬Ϻ,һ2-3ε,mʵʽܵ(m=4),Լ١
3.2Ǻƽĵʸļ
ڵƽһܵºܸӵά,״ǵĲΪǵƽб,Ϊߵʸļ㾫,ҪǺƽӰ졣ģͼĻ,ƽΪԿǡ巽Ϊ,״ģĽ,õγȺ;,Ӷ㺣ƽR
R=R-R򡡡(7)
״ͺƽཻ֮ľΪ
=Ѻ-򡡡(8)
ںΪ͹,״ʸļнǽС(״ǵİװǺǵ̬),
ѡ֦R(9)
Ե
֦Ѻ-R(10)
ƽӰΪ:(10)ʽεб,ɦõģͷʸ
3.3ǵλõļ
ݵʸڱķǱϵԹϵת,ڿռϵеλ
ri=-CibRb(11)
CibΪ嵽Կռת,ɸ,RbΪʸڱϵͶӰriΪڹԿռλʸ
εһμ㼴λõļ,ƽӰǵλáٶȺ̬,ҹϵʮָ,ֻͨ㲻߶λȡֵ㷨Աûно,ڷбȽ˲ͬӰ졣
ںƽģ, ,ɵʸ,ͬʱǷλȷ,߶Ӱ춨ľȡ(11)ʽ,ֱӶҪCibRbɡCibľҪȾ,Rbļȡ״߷ǵģľļ㾫ȼ״ǰװǵľȵȡֱӶ취ľ㷨̼ȷμף9ݡ
4Kalman˲
ֱӶ취Ȼ,ûпǱ˶,ÿζ㶼,˶쾫Խϵֱ͡Ӷ취Ϊ,ùKalman˲,Ǳ˶Խж̬,߶쾫ȡڲü(ֱӶ취Ľ,ǲ)ΪKalman˲Ĳ,ͳĹKalman˲㷨ʵ޸ġ
4.1Kalman˲㷨
ͳ¹Kalman˲ĲΪ
z=h(x,t)+v(12)
zΪ,x״̬,vΪӳİź,ֱӶ취ļźΪKalman,̵ʽͱΪ
g(x,z,v,t)=h(x,t)(13)
zΪ,x״̬,vΪӳİź,g(x,z,v,t)Ϊ״̬Ͳĺ,жӦֱӶ취ļڲ(13)ʽ봫ͳ¹Kalmam˲Ĳ(12)ʽͬ,Kalman˲㷨ʵӦ(13)ʽĲ,ĹKalman˲㷨㷨,㷨еgk(xk,zk,tk,vk)=zʱ,㷨˻ΪͳĹKalman˲㷨(ף4)
4.2˶Ͳģ
Kalman˲״̬ģΪڵĹϵпJ2㶯Ӱѧģֱ͡Ӷ취ļΪ,ģΪ
g=x* y* z*Th=x y zT(14)
ֱӶ취ļx*,y*,z*Ϊ1,2,3,,mai,bivĺ,g,hӦJacobΪ
(15)
hgľʽף9ݡ
㷨ɢKalman˲㷨
״̬ģ:x(t0)=x0
ģ:gk(xk,zk,tk,vk)=hk(xk,tk)k=1,2,
ͳ:E{x0xT0}=P0
E{w(t)}=0,E{w(t)wT(t)}=Q(t);
E{vk)=0,E{vk(t)vTk}=Rk;
E{x0wT(t)}=0,E{x0vTk)}=0;
E{w(t)vTk}=0;k=1,2,
KalmanԤ:
P(t0)=P0
Kalman˲:
Kk=P-kHTk(HkP-kHTk+SkRkSTk)-1
Kalman:

Kalman:
P+k=(I-KkHk)P-k
Jacobi:
;;
5ģ漰
ú߶ȼƵKalman˲İдĹ̬,ȿɽKalman˲Ľ,ټ,ֿϵͳȶԡKalman˲ǹ̬漰ϵͳͼͼ1ʾ

ͼ1˲켰ģͼ
˶ģ,ó˵㶯(n=30,m=28)̫㶯صӰ,ǵ̬˶򵥵زұ仯ģϵ̬ǵı仯;n=20ĺƽģģ⺣ƽ仯;˲ֵģ,԰еֵΪ˸߶ȡ
Թ߶Ϊ900km,98ļص͹Ϊģѡȡ20ǵĺǣ9ģĲ
ΪͱȽֱӶ취˲취,Զõĺƽģͽ߶ȡȡֱӶKalman˲ڵȲͬ״ֵģ,16,ֵΪ:
ƽģͽ3,10
߶ȡ0,10
ȡ0.0,0.003,0.005
ֱӶ1,2,3
˲ڡ1.0,5.0
Kalman˲״ֵ̬ƫΪ:λƫΪ1000,ٶƫΪ1.0/,̬λƫΪ0.5ȡģļ14,ͼ2ΪһʱߡģֱӼĶ쾫Ϊ400600,Kalman˲쾫Ϊ100,ʸľΪ0.004,ٶȾΪ0.50.6/롣
1ֱӺ˲(Ŷ뺣Ӱ)
(ֱӶ=3,=1.0롢ƽģͽ=3)

ź˸
(m)
(Deg)˲λ
(m)ֱӶλ
(m)ٶ
(m/s)Ƕ
(Deg)
100.00.00085780.350.0017
210.00.000934150.430.0041
310.00.0031145640.570.0043
410.00.0051447650.860.0050

2ֱӺ˲(ŶӰ뺣Ӱ)
(ֱӶ=3,=1.0롢ƽģͽ=10)

ź˸
(m)
(Deg)˲λ
(m)ֱӶλ
(m)ٶ
(m/s)Ƕ
(Deg)
500.00.00044380.240.0011
610.00.000544000.320.0038
710.00.003885600.530.0040
810.00.0051077570.790.0047

3ֱӺ˲(Ӱ)
(˸߶=10.0,ֱӶ=3,=5.0)

ź˸
(m)
(Deg)˲λ
(m)ֱӶλ
(m)ٶ
(m/s)Ƕ
(Deg)
9030.0032225710.750.0044
10030.0052697581.060.0055
11100.0031725560.630.0041
12100.0052087530.890.0052

4ֱӺ˲(ֱӶӰ)
(˸߶=10.0,=0.003,=1.0)

ź˸
(m)
(Deg)˲λ
(m)ֱӶλ
(m)ٶ
(m/s)Ƕ
(Deg)
132031315680.570.0043
14210855590.510.0040
151033596560.860.0052
161103816630.880.0051





ͼ2
Ƚϱ1ͱ2Ľ,Ǻ˸߶ȺӰ,ƽģͽȡ3׺10ʱ,쾫Լ40,ź˸߶Ⱥ,3׺10ʱKalman˲쾫ά40,ںƽǻ仯,˸߶Ⱥ,Kalman˲ֻɵӰ,ƽӰֻܸݺƽģ͵ļ3Kalman˲ڶԶ쾫ȵӰ졣4ӳֱӶԶ쾫ȵӰ졣εεĽͬ,ֻһεĶ쾫Խ,رKalman˲ľֻ400,ԭΪƽ¡
Kalman˲ĳʼٶȽϿ졣Ϊ1ʱ200ﵽȶ״̬,Ϊ5ʱ500ﵽȶ״̬,оͼñ׼ĹKalman˲,бֱӽ˲,ǲٶȺ,һ㶼1000ϡиĹKalman˲㷨нϺõ³,ھӦʱкܴ,ͬʱ˱׼ĹKalman˲㷨Ĺ淶ʽ
6
о,ɵ½:
ٺƽԵοο״߶ȼƽĶ쾫нϴӰ,ӰǲͨKalman˲,ֻͨƽģ
ڲòݵԤ(ֱӶļ)ΪKalman˲,ĹKalman˲,Kalman˲ܡ
۱иĹKalman˲㷨õԺȶԡ
ֱӶ취еĵʸ㷨򵥡ܿɿ,ṩ̬ǵļ,ڲòKalman˲ԼKalman˲ļ
ݸģ,ֱӼ㶨ľΪ400600,˲ľΪ100ҡ
ߵλպѧ..100083
ο
1Stewart R H.Method of Satellite Oceanography.University of California Press,1985
2H.ݶ.λۼڵ״ۺ͵еӦ.йҵ,19632
3͢.ϵͳ().뺽顪Һ嵯ػϵ,,19893
4Lewis F L.Optimal Esimation with an Introduction to Stochastic Control Theory.John Wiley & Sons,1986
5.ִۻ.ҵ,1981
6Dennis J E,Schnabel Robert B.Numerical Methods for Unconstrained Optimization and Nonlinear Equation.
7Kane T R.Spacecraft Dynamics,McGraw-Hill.New York,1983
8·,˻.ǲֲ.ѧ,199312
9,Ϊ.״ǵ.йռ似оԺ,19967
ո:19961120,޻:1998812
