7
五、模型的建立与求解
5.1 问题一的建模与求解
卫星轨道的精确估计是空间飞行器轨道估计的基础,该问题的目的便是对卫星的轨
道参数进行估计。在已知卫星初始时刻的轨道参数及其运动方程的条件下,通过解常微
分方程即可得到卫星轨道的参数。在对常微分方程进行降阶之后,采用了一种自适应定
点的四阶龙格库塔算法,得到卫星轨道的数值解,为空间飞行器的轨道估计奠定基础。
5.1.1 卫星轨道模型及算法
根据题中所给的观测卫星的简化运动方程及其初始条件建立卫星轨迹的常微分方
程组:
()
()
2
09
09
23
09
09 0 0 0
()
()
|()|
()
()
(0) , ,
(0) (0), (0), (0)
m
e
T
xyz
dR t G
FRt
dt r t
dR t
vt
dt
Rxyz
vvvv
⎧
==−
⎪
⎪
⎪
⎪
=
⎨
⎪
⎪
=
⎪
⎪
=
⎩
(5.1-1)
代入
()
09
() (), (), ()
T
txtytzt=
和
)
() (), (), ()
T
xyz
vt v t v t v t=
于公式(5.1-1)得到模型:
2
3/2
2
222
2
3/2
2
222
2
3/2
2
222
() ()
() ()
() () ()
() ()
() ()
() () ()
() ()
() ()
() () ()
⎧
⎪
=− =
⎪
⎡⎤
++
⎣⎦
⎪
⎪
⎪
=− =
⎨
⎡⎤
++
⎪
⎣⎦
⎪
⎪
=− =
⎪
⎡⎤
++
⎪
⎣⎦
⎩
m
x
m
y
m
z
G
dxt dxt
tvt
dt dt
xt yt zt
G
dyt dyt
tvt
dt dt
xt yt zt
G
dzt dzt
zt v t
dt dt
xt yt zt
(5.1-2)
式(5.1-2)构成了基本的运动轨道模型,进一步联合初始时刻卫星的初值,采用自适应定
点的四阶龙格库塔算法
[1]
(Adaptive Fixed Point-4-Optical Step Runge-Kutta, AFP-4-OSRK)
求解出卫星轨迹的数值解。
表 5.1 09 号卫星的初始时刻位置与速度
位置/m 数值 速度/m/s 数值
()
t
2043922.166765
()
x
vt
5379.544693−
()
t
8186504.631471
()
x
vt
407.095342−
()zt
4343461.714791
()
x
vt
3516.052656−