C语言-详细计算GPS卫星位置.doc

C语言计算GPS卫星位置1 概述在用GPS信号进行导航定位以及制订观测计划时，都必须已知GPS卫星在空间的瞬间位置。卫星位置的计算是根据卫星电文所提供的轨道参数按一定的公式计算的。本节专门讲解观测瞬间GPS卫星在地固坐标系中坐标的计算方法。2 卫星位置的计算1. 计算卫星运行的平均角速度n根据开普勒第三定律，卫星运行的平均角速度n0可以用下式计算 式中为WGS-84坐标系中的地球引力常数，且3.9860051014m3/s2。平均角速度n0加上卫星电文给出的摄动改正数n，便得到卫星运行的平均角速度nnn0n 4-122. 计算归化时间tk首先对观测时刻t作卫星钟差改正tt-t然后对观测时刻t归化到GPS时系tkt-toc 4-13式中tk称作相对于参考时刻toe的归化时间(读者注意toctoe)。3. 观测时刻卫星平近点角Mk的计算MkM0ntk 4-14式中M0是卫星电文给出的参考时刻toe的平近点角。4. 计算偏近点角EkEkMkesinEkEk,Mk以弧度计 (4-15)上述方程可用迭代法进行解算，即先令EkMk,代入上式，求出Ek再代入上式计算，因为GPS卫星轨道的偏心率e很小，因此收敛快，只需迭代计算两次便可求得偏近点角Ek。5. 真近点角Vk的计算由于 因此 6升交距角k的计算为卫星电文给出的近地点角距。7. 摄动改正项u,r,i的计算 u,r,i分别为升交距角u的摄动量，卫星矢径r的摄动量和轨道倾角i的摄动量。8. 计算经过摄动改正的升交距角uk、卫星矢径rk和轨道倾角ik 9. 计算卫星在轨道平面坐标系的坐标卫星在轨道平面直角坐标系(X轴指向升交点)中的坐标为 10. 观测时刻升交点经度k的计算升交点经度k等于观测时刻升交点赤经(春分点和升交点之间的角距)与格林泥治视恒星时GAST(春分点和格林尼治起始子午线之间的角距)之差，k-GAST (4-23)又因为 4-24其中oe为参与时刻toe的升交点的赤经；是升交点赤经的变化率，卫星电文每小时更新一次和toe。此外，卫星电文中提供了一周的开始时刻tw的格林尼治视恒星时GASTw。由于地球自转作用，GAST不断增加，所以GASTGASTwet (4-25)式中e7.2921156710-5rad/s为地球自转的速率；t为观测时刻。由式(4-24)和(4-25)，得 由(4-13)式，得其中，的值可从卫星电文中获取。11. 计算卫星在地心固定坐标系中的直角坐标把卫星在轨道平面直角坐标系中的坐标进行旋转变换，可得出卫星在地心固定坐标系中的三维坐标 12. 卫星在协议地球坐标系中的坐标计算考虑极移的影响，卫星在协议地球坐标系中的坐标为利用C语言程序实现include stdio.hinclude string.hinclude stdlib.hinclude math.hdefine u 3.986004418e14define WE 7.292115e-6struct canshuint prn, nian, yue, ri, shi, fen;卫星PRN号，年，月，日，时，分double miao;秒long double adoe, a0, a1, a2, mo, dn, e, ga, pio, io, w, pid, ii, cuc, cus, cue, crs, crc, cis, cic, toe, aodc, wn;/*参数说明 ADOE值，a0 卫星钟偏差, a1 卫星钟漂移, a2 卫星钟频率漂移, M0 平近点角, n平运动差, e偏心率, a1/2半长轴的平方根, 0 轨道平面升交点经度, i0 倾角, 近地点角距, * 升交点速率, IDot 倾角速率, Cuc Cus 升交角距的摄动改正项,Crc Crs 地心距的摄动改正项, Cic Cis 倾角的摄动改正项,toe 参考历元*/;void wxzbjxstruct canshu *ptlong double a, n0, n, t, tk, toc, mk, ek, vk, fik, uk, rk, ik;long double xk, yk ,zk, lk;long double XK, YK, ZK;int temp;pt-nian pt-nian 2000;t long doublept -nian- 1980 * 365 * 24 * 3600 pt -yue - 1 * 30 * 24 * 3600 pt -ri * 24 * 3600 pt-shi * 3600 pt -miao;a pt -ga * pt -ga;n0 sqrtWE/a*a*a;平均角速度n0n n0 pt -dn;tk t - pt -toe;toc pt -a0 pt -a1 * t - pt -toe pt -a2 * t - pt-toe * t - pt -toe;tk tk - pt -toe;mk pt -mo n * tk;ek mk;fortemp0;temp10;temp ekmk pt -e * sinek;利用迭代法求偏近点角ek vk 2 * atansqrt1 pt -e / 1 - pt -e* tanek / 2 ;fik vk pt -w;uk fik pt -cuc * cos2* fik pt -cus * sin2*fik;rk pt -ga * pt -ga * 1 - pt -e * ek pt -crc * cos2* fik pt -crs * sin2*fik;ik pt -io pt -cic * cos2 * fik pt -cis * sin2* fik pt -ii * tk; xk rk * cosuk;yk rk * sinuk;zk 0;lk pt -pio pt -pid - WE * tk - WE * pt-toe;XK xk * coslk - yk * cosik * sinlk;YK xk * sinlk yk * cosik * coslk;ZK yk * sinik;printfnd年d月d号d时.2f秒 d号卫星的坐标, pt-nian, pt-yue ,pt-ri , pt-shi ,pt-miao, pt-prn;printfnXk .9fnYk .9fnZK .9fnn, XK, YK, ZK; int mainvoidFILE *fp, *fp1, *fp2;struct canshu a;int i0, hanhao 1; long doubletemp1, temp2, temp3, temp5, temp4, temp6, temp7;char ch, ch1;iffp1 E星历文件guangboxingli2.txt, r NULL请自定义星历文件位置及名称printf文件无法打开;exit0; elseiffp2 E星历文件guangboxingli2fu.txt, w NULLprintf文件无法打开;exit0; elsewhilech1 fgetcfp1 EOFifch1 ni ;putcharch1;ifi 15break;whilefeoffp1ch1fgetcfp1;ifch1 Dch1 e;fputcch1,fp2;fclosefp1; fclosefp2;printf以上是星历文件的头文件n;systempause;printf读取文件参数数据n;iffp E星历文件guangboxingli2fu.txt, r NULL创建计算结果文档printf文件无法打开;exit0; whilefeoffpswitchhanhaocase 1fscanffp,nddddddlf le le le, a.prn, a.nian, a.yue, a.ri, a.shi, a.fen, a.miao, a.a0, a.a1, a.a2;printfd d d d d d lf le le le, a.prn, a.nian, a.yue, a.ri, a.shi, a.fen, a.miao, a.a0, a.a1, a.a2;hanhao;case 2fscanffp,le le le le, a.adoe, a.crs, a.dn, a.mo;printfnle le le le, a.adoe, a.crs, a.dn, a.mo;hanhao;case 3fscanffp,le le le le, a.cue, a.e, a.cus, a.ga;printfnle le le le, a.cue, a.e, a.cus, a.ga;hanhao;case 4fscanffp,le le le le, a.toe, a.cic, a.pio, a.cis;printfnle le le le, a.toe, a.cic, a.pio, a.cis;hanhao;case 5fscanffp,le le le le, a.io, a.crc, a.w, a.pid;printfnle le le le, a.io, a.crc, a.w, a.pid;hanhao;case 6fscanffp,le le le le, a.ii, temp1, a.wn, temp2;printfnle le le le, a.ii, temp1, a.wn, temp2;hanhao;case 7fscanffp,le le le le, temp3, temp4, temp5, a.aodc;printfnle le le le, temp3, temp1, temp5, a.aodc;hanhao;case 8fscanffp,le, temp6;printfnle, temp6;ifchfgetcfp nfscanffp,le, temp7;printf len, temp7;wxzbjxa;systempause;hanhao 1;fclosefp;return 0;