C语言计算GPS卫星位置

1、C 语 言 计 算 G P S 卫 星 位 置1 概述在用GPS信号进行导航定位以及制订观测计划时，都必须已知GPS卫星在空间的瞬间位置。卫星位置的计算是根据卫星电文所提供的轨道参数按一定的公式计算的。本节专门 讲解观测瞬间 GPS卫星在地固坐标系中坐标的计算方法。2 卫星位置的计算1. 计算卫星运行的平均角速度 n根据开普勒第三定律，卫星运行的平均角速度 n0 可以用下式计算：式中为 WGS-84坐标系中的地球引力常数，且口=x 1014m7s2。平均角速度 no加上卫星电文给出的摄动改正数 n,便得到卫星运行的平均角速度nn二ro+A n(4-12)2. 计算归化时间 t k首先对观测时刻

2、t'作卫星钟差改正t=t ' - A t然后对观测时刻t归化到GPS时系t k=t-t oc(4-13)式中t k称作相对于参考时刻 t oe的归化时间(读者注意：toc工toe )。3. 观测时刻卫星平近点角 Mk 的计算Mk=Mo+ntk(4-14)式中M是卫星电文给出的参考时刻 toe的平近点角。4. 计算偏近点角 Ek上述方程可用迭代法进行解算，即先令Ek=Mk, 代入上式，求出 Ek 再代入上式计算，因为GPS卫星轨道的偏心率 e很小，因此收敛快，只需迭代计算两次便可求得偏近点角巳。5. 真近点角 Vk 的计算由于:因此:6. 升交距角k的计算3为卫星电文给出的近地点

3、角距。7. 摄动改正项3 u, S r, S i的计算S u, S r, S i分别为升交距角 u的摄动量，卫星矢径r的摄动量和轨道倾角i的摄动量。8. 计算经过摄动改正的升交距角uk、卫星矢径rk和轨道倾角ik9. 计算卫星在轨道平面坐标系的坐标卫星在轨道平面直角坐标系（x轴指向升交点）中的坐标为10. 观测时刻升交点经度Q k的计算升交点经度Q k等于观测时刻升交点赤经Q （春分点和升交点之间的角距）与格林泥治视恒星时GAST（春分点和格林尼治起始子午线之间的角距）之差，Q k=Q -GAST（ 4-23 ）又因为 :oe tk （4-24）其中Q oe为参与时刻toe的升交点的赤经；是升

4、交点赤经的变化率，卫星电文每小时更新一次Q和toe。此外，卫星电文中提供了一周的开始时刻tw的格林尼治视恒星时GAST。由于地球自转作用，GAST不断增加，所以：式中w eX 10-5rad/s 为地球自转的速率；t为观测时刻。由式（ 4-24）和（ 4-25），得:由（ 4-13 ）式，得 :其中0 oe GASTw , O、toe的值可从卫星电文中获取。11. 计算卫星在地心固定坐标系中的直角坐标 把卫星在轨道平面直角坐标系中的坐标进行旋转变换，可得出卫星在地心固定坐标系中的三维坐标：12. 卫星在协议地球坐标系中的坐标计算 考虑极移的影响，卫星在协议地球坐标系中的坐标为利用 C 语言程序

5、实现#include <>#include <>#include <>#include <>#define WEstruct canshuint prn, nian, yue, ri, shi, fen;f 秒 %d 号卫星的坐标："，pt->nian, pt->yue ,pt->ri , pt->shi ,pt->miao, pt->prn）;printf（"nXk = %.9fnYk= %.9fnZK = %.9fnn", XK, YK, ZK）;int main（void）F

6、ILE *fp, *fp1, *fp2;struct canshu a;int i=0, hanhao = 1;long double temp1, temp2, temp3, temp5, temp4, temp6, temp7;char ch, ch1;名称printf(" 文件无法打开！ ");exit(0);else星历文件 ", "w") = NULL)printf(" 文件无法打开！ ");exit(0);elsewhile(ch1 = fgetc(fp1) != EOF)if(ch1 = 'n'

7、)i +;putchar(ch1);if(i = 15) break;while(!feof(fp1)ch1=fgetc(fp1);if(ch1 = 'D')ch1 = 'e'fputc(ch1,fp2);fclose(fp1);fclose(fp2);printf(" 以上是星历文件的头文件！ n");system("pause");printf(" 读取文件参数数据 n ！");星历文件 ", "r") = NULL)/ 创建计算结果文档printf(" 文件

8、无法打开！ ");exit(0);while(!feof(fp)switch(hanhao)case 1:fscanf(fp,"n%d%d%d%d%d%d%lf %le %le %le", &, &,&, &, &,&, &, &, &, & printf("%d %d %d %d %d %d %lf %le %le %le", , , , , ,J J J J Jhanhao+;case 2:fscanf(fp,"%le %le %le %le"

9、;, &, &, &, & printf("n%le %le %le %le", , , , ; hanhao+;case 3:fscanf(fp,"%le %le %le %le", &, &, &, & printf("n%le %le %le %le", , , , ; hanhao+;case 4:fscanf(fp,"%le %le %le %le", &, &, &, & printf("n%le

10、%le %le %le", , , , ; hanhao+;case 5:fscanf(fp,"%le %le %le %le", &, &, &, & printf("n%le %le %le %le", , , , ; hanhao+;case 6:fscanf(fp,"%le %le %le %le", &, &temp1, &, &temp2); printf("n%le %le %le %le", , temp1, , temp2); hanhao+;case 7:fscanf(fp,"%le %le %le %le", &temp3, &temp4, &temp5, &printf("n%le %le %le %le", temp3, temp1, temp5, ; hanhao+;case 8:fscanf(fp,"%le", &temp6); printf("n%le", temp6); if(ch=f