C语言计算GPS卫星位置
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
C 语言计算GPS 卫星位置
1 概述
在用GPS 信号进行导航定位以及制订观测计划时,都必须已知GPS 卫星在空间的瞬间位置。卫星位置的计算是根据卫星电文所提供的轨道参数按一定的公式计算的。本节专门讲解观测瞬间GPS 卫星在地固坐标系中坐标的计算方法。 2 卫星位置的计算
1. 计算卫星运行的平均角速度n
根据开普勒第三定律,卫星运行的平均角速度n0可以用下式计算:
()
114/3
)(30-=
=a M a G n μ
式中μ为WGS-84坐标系中的地球引力常数,且μ=3.986005×1014m 3/s 2。平均角速度n 0加上卫星电文给出的摄动改正数Δn ,便得到卫星运行的平均角速度n
n=n 0+Δn (4-12)
2. 计算归化时间t k
首先对观测时刻t ′作卫星钟差改正
t=t ′-Δt
2)'()'(210oc oc t t a t t a a t -+-+=∆
然后对观测时刻t 归化到GPS 时系
t k =t-t oc (4-13)
式中t k 称作相对于参考时刻t oe 的归化时间(读者注意:toc ≠toe )。 3. 观测时刻卫星平近点角M k 的计算
M k =M 0+n tk (4-14)
式中M 0是卫星电文给出的参考时刻toe 的平近点角。 4. 计算偏近点角E k
E k =M k +esinE k (E k ,M k 以弧度计) (4-15)
上述方程可用迭代法进行解算,即先令E k =M k ,代入上式,求出E k 再代入上式计算,因为GPS 卫星轨道的偏心率e 很小,因此收敛快,只需迭代计算两次便可求得偏近点角E k 。 5. 真近点角V k 的计算
由于:
()164)
cos 1()(cos cos ---=k k k E e e E V
()
174)(cos sin 1sin 2-⎥⎦
⎤
⎢⎣⎡-⋅-=e E E e arctg V k k k
因此:
()
184)(cos sin )1(2-⎥⎦
⎤⎢⎣⎡-⋅-=e E E e arctg V k k k
6.升交距角Φk 的计算
(419)k k V φϖ
=+-
ω为卫星电文给出的近地点角距。
7. 摄动改正项δu,δr,δi 的计算
cos(2)sin(2)cos(2)sin(2)(420)
cos(2)sin(2)u uc k us k r rc k rs k ic k k C C r C C ri C Cis δφφδφφδφφ⎫
=⋅+⋅⎪
=⋅+⋅-⎬⎪=⋅+⋅⎭
δu,δr,δi 分别为升交距角u 的摄动量,卫星矢径r 的摄动量和轨道倾角i
的摄动量。
8. 计算经过摄动改正的升交距角u k 、卫星矢径r k 和轨道倾角i k
0(1cos )(421)
k k u
k k r k i k u r a e E i i It φδδδ=+⎫⎪
=-+-⎬
⎪=++⎭
9. 计算卫星在轨道平面坐标系的坐标
卫星在轨道平面直角坐标系(X 轴指向升交点)中的坐标为
cos (422)
sin k k k k k k x r u y r u =⎫
-⎬
=⎭
10. 观测时刻升交点经度Ωk 的计算
升交点经度Ωk 等于观测时刻升交点赤经Ω(春分点和升交点之间的角距)与格林泥治视恒星时GAST (春分点和格林尼治起始子午线之间的角距)之差,
Ωk =Ω-GAST (4-23) 又因为:
tk oe Ω+Ω=Ω (4-24)
其中Ωoe 为参与时刻t oe 的升交点的赤经;
Ω
是升交点赤经的变化率,卫星电文每小时更新一次Ω和t oe 。
此外,卫星电文中提供了一周的开始时刻t w 的格林尼治视恒星时GAST w 。由于地球自转作用,GAST 不断增加,所以:
GAST=GAST w +ωe t (4-25)
式中ωe =7.29211567×10-5rad/s 为地球自转的速率;t 为观测时刻。 由式(4-24)和(4-25),得:
(4-26) k oe w e GAST t
ωΩ=Ω--
由(4-13)式,得:
0()(4-27)k e k e oe
t t ωωΩ=Ω+Ω--
其中
0oe w GAST Ω=Ω-,o Ω、Ω、oe t 的值可从卫星电文中获取。
11. 计算卫星在地心固定坐标系中的直角坐标
把卫星在轨道平面直角坐标系中的坐标进行旋转变换,可得出卫星在地心固定坐标系中的三维坐标:
cos cos sin sin cos cos (4-28)
sin k k k k k k k k
k k i k k k k X x y i Y x y i Z y i Ω-Ω⎡⎤⎡⎤⎢⎥⎢⎥
=Ω+Ω⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦
12. 卫星在协议地球坐标系中的坐标计算
考虑极移的影响,卫星在协议地球坐标系中的坐标为
p p p p 1 0 X 0 1 Y (429)
X Y 1k k k CTS X X Y Y Z Z ⎡⎤⎡⎤⎡⎤
⎢⎥⎢⎥
⎢⎥=-⎢⎥⎢⎥⎢⎥
⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦
⎣⎦