#include
#include
#include
#include
#include
#include
#include“matrix.h“
using?namespace?std;
#include“mystruct.h“
//以下矩陣要用------------------
using?namespace?std;???????????//
#ifndef?_NO_NAMESPACE??????????//
using?namespace?math;??????????//
#define?STD?std????????????????//
#else??????????????????????????//
#define?STD????????????????????//
#endif?????????????????????????//
???????????????????????????????//
#ifndef?_NO_TEMPLATE???????????//
typedef?matrix?Matrix;?//?
#else??????????????????????????//
typedef?matrix?Matrix;?????????//?
#endif//--------
///////////////////////
/////////////////////////////////////////////////
void?GEO（int&?posktime_gps&?t2double&?trsta_polar&?spvector&?vn）
{
	//double?pi=3.1415926535898;
	double?tk=t2.num_sec-vn[posk].TOE.num_sec+（t2.num_week-vn[posk].TOE.num_week）*604800;//正常減出來是-14.050
	//double?tk=-14.5;
	double?const?GM=3.9860047e14;
	double?const??we=7.29211514767e-5;//地球自轉角速度
	double?const?pi=3.1415926535898;
	double?const?c=2.99792458e8;//光速
	double?n0=sqrt（GM）/pow（vn[posk].sqrtA3）;
	double?e_n=n0+vn[posk].delta_n;
	if（tk>302400）?tk=tk-604800;
	if（tk<-302400）?tk=tk+604800;
	double?M=vn[posk].M0+tk*e_n;//平近點角
	//cout<<“M平近點角=“<	double?EE0Ek;
	/////迭代偏近點角
	E0=M;
	?do
	?{Ek=E0;
	?E=M+vn[posk].e*sin（Ek）;
	?E0=E;
	?}while（fabs（E-Ek）>1e-12）;//fabs浮點數取絕對值
	//?cout<<“偏近點角E“<	?double?vk=atan2（（sqrt（1-vn[posk].e*vn[posk].e）*sin（E））cos（E）-vn[posk].e）;//注意atan和atan2的區別
	?//cout<<“真近點角“<	?double?faik=vk+vn[posk].w;
	?//cout<<“升交距角“<	?/////攝動改正項u，r，i計算
	?double?duk=vn[posk].Cuc*cos（2*faik）+vn[posk].Cus*sin（2*faik）;//升交距角u的攝動量
	?double?drk=vn[posk].Crc*cos（2*faik）+vn[posk].Crs*sin（2*faik）;//衛星矢徑r的攝動量
	?double?dik=vn[posk].Cic*cos（2*faik）+vn[posk].Cis*sin（2*faik）;//軌道傾角i的攝動量
	?//經過攝動改正后的
	?double?uk=duk+faik;
	?double?rk=vn[posk].sqrtA*vn[posk].sqrtA*（1-vn[posk].e*cos（E））+drk;
	?double?ik=vn[posk].i0+dik+vn[posk].i_DOT*tk;
	//?cout<<“升交距角uk“<	?//衛星在軌道平面坐標系的坐標
	?double?xkd=rk*cos（uk）;
	?double?ykd=rk*sin（uk）;
	?////改正后升交點經度
	//?tk=-14.50000011920929;
	?double?tempp1=vn[posk].OMEGA;
	?double?tempp2=vn[posk].OMEGA_DOT;
	double?tempp3=?t2.num_sec;

	?double?omgak=vn[posk].OMEGA+（vn[posk].OMEGA_DOT）*tk-we*vn[posk].TOE.num_sec;
	??//omgak=-34.497361011748382;
	??//計算衛星在地心固定坐標系中的直角坐標
	?double?xk=xkd*cos（omgak）-ykd*cos（ik）*sin（omgak）;
	?double?yk=xkd*sin（omgak）+ykd*cos（ik）*cos（omgak）;
	?double?zk=ykd*sin（ik）;
	?
	?///////計算衛星在CGCS2000中的坐標
	?//double?Rx[3][3]?=?{{100}{0cos（-5.0?/?180?*?pi）sin（-5.0?/?180?*?pi）}{0-sin（-5.0?/?180?*?pi）cos（-5.0?/?180?*?pi）}};?//C++中cossinasinacos這些三角函數操作的是弧度而非角度！！！
		//double?Rz[3][3]?=?{{cos（we?*?tk）sin（we?*?tk）0}{-sin（we?*?tk）cos（we?*?tk）0}{001}};
		//double?R[3][3]sat[3][1];
		//double?satuser[3][1]?=?{xkykzk};
????????Matrix?A（33

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????目錄???????????0??2016-08-14?11:59??BD\
?????目錄???????????0??2016-08-11?22:22??BD\BD\
?????文件????????4317??2016-08-01?11:12??BD\BD\BD.vcxproj
?????文件????????1649??2016-08-01?11:12??BD\BD\BD.vcxproj.filters
?????目錄???????????0??2016-08-12?19:56??BD\BD\Debug\
?????文件????????1693??2016-08-01?11:33??BD\BD\Debug\BD.Build.CppClean.log
?????文件??????????59??2016-08-12?11:56??BD\BD\Debug\BD.lastbuildstate
?????文件????????6905??2016-08-12?11:56??BD\BD\Debug\BD.log
?????文件???????25516??2016-08-12?11:56??BD\BD\Debug\CL.read.1.tlog
?????文件????????1338??2016-08-12?11:56??BD\BD\Debug\CL.write.1.tlog
?????文件????????2602??2016-08-12?11:56??BD\BD\Debug\cl.command.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link-cvtres.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link-cvtres.write.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link-rc.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link-rc.write.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.2828-cvtres.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.2828-cvtres.write.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.2828-rc.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.2828-rc.write.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.2828.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.2828.write.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.3920-cvtres.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.3920-cvtres.write.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.3920-rc.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.3920-rc.write.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.3920.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.3920.write.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.4372-cvtres.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.4372-cvtres.write.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.4372-rc.read.1.tlog
?????文件???????????2??2016-08-12?11:56??BD\BD\Debug\link.4372-rc.write.1.tlog
............此處省略47個文件信息