卫星坐标计算

hhd[j].ek2=hhd[j].Mk+hhd[j].e*sin(hhd[j].ek1);
hhd[j].Ek=hhd[j].Mk+hhd[j].e*sin(hhd[j].ek2);
//计算观测时刻的偏近点角Ek
hhd[j].cosVk,hhd[j].sinVk;
hhd[j].cosVk=(cos(hhd[j].Ek)-hhd[j].e)/(1-hhd[j].e*cos(hhd[j].Ek));
void mult(GPS &p );
};
double GPS::TIME(int nYear,int nMonth,int nDay,int nHour,int nMinute,double dSecond)
{
//计算时间，有GPS接收时间转化成儒略日
double m_dWeekSecond;
else
hhd[j].Vk=2*PI-acos(hhd[j].cosVk);
/*Vk=atan((sqrt(1-e*e)*sin(Ek))/(cos(Ek)-e));*///计算真近点角Vk
hhd[j].Qk=hhd[j].Vk+hhd[j].w; //计算升交距角Qk
if(hhd[j].Y>].Y;
else if(Y<80&&Y>=0)
hhd[j].Y=2000+hhd[j].Y;
hhd[j].t=hhd[j].TIME(hhd[j].Y,hhd[j].M,hhd[j].D,hhd[j].H,hhd[j].min,hhd[j].sec);
hhd[j].toe>>hhd[j].Cic>>hhd[j].Wo>>hhd[j].Cis>>hhd[j].I>>hhd[j].Crc>>hhd[j].w>>hhd[j].W>>hhd[j].Idot>>hhd[j].L2>>hhd[j].GPSn_week>>
hhd[j].L2P>>hhd[j].wxjd>>hhd[j].MSB>>hhd[j].TGD>>hhd[j].IODC>>hhd[j].sendtime;
hhd[j].xk=hhd[j].rk*cos(hhd[j].uk);
hhd[j].yk=hhd[j].rk*sin(hhd[j].uk); //计算卫星的轨道坐标系的位置
hhd[j].Lk=hhd[j].Wo+(hhd[j].W-we)*hhd[j].tk-we*hhd[j].toe; //计算t时刻升交点经度Lk
#include "stdafx.h"
#include <iostream>
#include<stdio.h>
#include<math.h>
#include<iomanip>
#include<fstream>
#include<string>
using namespace std;
int DayofMonth=0,DayofYear=0,weekno=0,dayofWeek,m;
if(nYear<1980||nMonth<1||nMonth>12||nDay>31)return -1;
for(m=1980;m<nYear;m++)
{
if((m%4==0 && m%100!=0) || m%400==0)
}
int j=0;
for(j=0;j<175;j++)
{
//do
//{
in>>hhd[j].w_n>>hhd[j].Y>>hhd[j].M>>hhd[j].D>>hhd[j].H>>hhd[j].min>>hhd[j].sec
>>hhd[j].a0>>hhd[j].a1>>hhd[j].a2>>hhd[j].aode>>hhd[j].Crs>>hhd[j].dn>>hhd[j].Mo>>hhd[j].Cuc>>hhd[j].e>>hhd[j].Cus>>hhd[j].a>>
double dn,Mo,e,w,Cuc,Cus,Crc,Crs,Cis,Cic,Wo,W,n0;
double n,Ek,Ek0,Mk,Vk,Ok,du,di,dr,uk,rk,ik,xk,yk,zk,Lk,Xk,Yk,Zk,Qk,a,UT,io,wo,I,JD,tk,toe,Idot,t;
DayofMonth+=28;
}
}//计算当前一年元月到当前前一月的天数
DayofMonth=DayofMonth+nDay-6;//加上当月天数减去1980年元月6日
weekno=(DayofMonth+DayofYear)/7;//计算GPS周
dayofWeek=(DayofMonth+DayofYear)%7;//计算GPS周秒时间
int w_n ,Y,M,D,H,min;
double sec,a1,a2,a0,aode,L2,GPSn_week,L2P,wxjd,MSB,TGD,IODC,sendtime,wm,ek1,ek2,cosVk,sinVk;
double TIME(int nYear,int nMonth,int nDay,int nHour,int nMinute,double dSecond);
ofstream fout;
fout.open("结果文件.txt");
string str;
while(getline(in,str))
{
string::size_type pos=str.find("ENE OF HEAEER");
if(pos!=string::npos)break;
hhd[j].Zk=hhd[j].yk*sin(hhd[j].ik); //计算卫星在WGS-84坐标系的位置
fout<<"卫星"<<hhd[j].w_n<<"在"<<hhd[j].Y<<"年"<<hhd[j].M<<"月"<<hhd[j].D<<"日"<<hhd[j].H+8<<"时"<<hhd[j].min<<"分"<<hhd[j].sec<<"秒"<<"的相关参数："<<endl;
m_dWeekSecond=dayofWeek*86400+nHour*3600+nMinute*60+dSecond;
return m_dWeekSecond;
}
void GPS::mult(GPS &p)
{
GPS hhd[175];
fstream in;
in.open("b3062240.11n");
hhd[j].du=hhd[j].Cuc*cos(2*hhd[j].Qk)+hhd[j].Cus*sin(2*hhd[j].Qk);
hhd[j].dr=hhd[j].Crc*cos(2*hhd[j].Qk)+hhd[j].Crs*sin(2*hhd[j].Qk);
hhd[j].di=hhd[j].Cic*cos(2*hhd[j].Qk)+hhd[j].Cis*sin(2*hhd[j].Qk);//计算摄动改正项ru,rr,ri
hhd[j].uk=hhd[j].Qk+hhd[j].du;
hhd[j].rk=(1-hhd[j].e*cos(hhd[j].Ek))*hhd[j].a*hhd[j].a+hhd[j].dr;
hhd[j].ik=hhd[j].I+hhd[j].di+hhd[j].Idot*hhd[j].tk; //计算摄动改正的升交距角uk，卫星向径rk和轨道倾角ik
double power(double x,double n)
{
double val=1.0;
while(n--)
val*=x;
return val;
}
const double PI=3.1415926;
const double we=7.29211567/power(10,5);
else if(hhd[j].sinVk>0 && hhd[j].cosVk<0)
hhd[j].Vk=acos(hhd[j].cosVk);
else if(hhd[j].sinVk<0 && hhd[j].cosVk<0)
hhd[j].Vk=PI-asin(hhd[j].sinVk);
else if(m==4||m==6||m==9||m==11)
DayofMonth+=30;
else if(m==2)