#include“Matrix.h“
#include?
#include?
#include?
#include?
using?namespace?std;
#define?FE_WGS84????（1.0/298.257223563）?/*?earth?flattening?（WGS84）?*/
#define?RE_WGS84????6378137.0???????????/*?earth?semi-major?axis?（WGS84）?（m）?*/
#define?PI????3.141592653589793???
void?Rx（double*?posdouble*?E）;????????????????????????????//函數(shù)定義頭


void?main（）
{
	int?ij;
	double?a[16000][6]={0}b[16000][3]={0}pos[3]={0}E[9]={0}e[3]={0}enu[3]={0};
	FILE?*fp1*fp2;
	
?????????????????????????????????
	fp1=fopen（“GGBB.txt““r“）;
	for（i=0;i<16000;i++）??????????????????????????????????
???{
		for（j=0;j<6;j++）
		{
			?fscanf（fp1“%lf“&a[i][j]）;
		}
	}
	fclose（fp1）;

????for（i=0;i<16000;i++）
	{
	????double?e2=FE_WGS84*（2.0-FE_WGS84）r2=a[i][0]*a[i][0]+a[i][1]*a[i][1]zzkv=RE_WGS84sinp;
????
		for?（z=a[i][2]zk=0.0;fabs（z-zk）>=1E-4;）?
			{
				zk=z;
				sinp=z/sqrt（r2+z*z）;
				v=RE_WGS84/sqrt（1.0-e2*sinp*sinp）;
				z=a[i][2]+v*e2*sinp;
			}
			pos[0]=r2>1E-12?atan（z/sqrt（r2））:（a[i][2]>0.0?PI/2.0:-PI/2.0）;
			pos[1]=r2>1E-12?atan2（a[i][1]a[i][0]）:0.0;
			pos[2]=sqrt（r2+z*z）-v;
???????
			Rx（posE）;
			e[0]=a[i][3]-a[i][0];e[1]=a[i][4]-a[i][1];e[2]=a[i][5]-a[i][2];
			Matrix?R1（33E）;?Matrix?R2（31e）;?Matrix?R3（31enu）;?
????????????R3=R1*R2;
		????b[i][0]=R3.GetData（）[0];b[i][1]=R3.GetData（）[1];b[i][2]=R3.GetData（）[2];
	}

	fp2=fopen（“GGBB-enu.txt““w“）;
	fprintf（fp2“???e?????????n?????????u\n“）;
	for（i=0;i<16000;i++）??????????????????????????????????
???{
				
	??fprintf（fp2“%-10.3f%-10.3f%-10.3f\n“b[i][0]b[i][1]b[i][2]）;
		
	}
????fclose（fp2）;

	
}



void?Rx（double*?posdouble*?E）
{
????double?sinp=sin（pos[0]）cosp=cos（pos[0]）sinl=sin（pos[1]）cosl=cos（pos[1]）;
????
????E[0]=-sinl;??????E[1]=cosl;???????E[2]=0.0;
????E[3]=-sinp*cosl;?E[4]=-sinp*sinl;?E[5]=cosp;
????E[6]=cosp*cosl;??E[7]=cosp*sinl;??E[8]=sinp;

}

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????目錄???????????0??2015-12-03?14:13??xyz-enu批量\
?????文件?????1356978??2015-03-19?19:25??xyz-enu批量\BB.txt
?????目錄???????????0??2015-12-03?14:13??xyz-enu批量\Debug\
?????文件???????16923??2015-03-19?19:24??xyz-enu批量\Debug\main.obj
?????文件???????15310??2015-03-19?19:24??xyz-enu批量\Debug\Matrix.obj
?????文件??????270418??2015-03-19?19:24??xyz-enu批量\Debug\Precession.exe
?????文件??????399424??2015-03-19?19:24??xyz-enu批量\Debug\Precession.ilk
?????文件?????1393664??2015-03-19?19:29??xyz-enu批量\Debug\Precession.pdb
?????文件??????107520??2015-03-19?19:24??xyz-enu批量\Debug\vc60.idb
?????文件??????118784??2015-03-19?19:24??xyz-enu批量\Debug\vc60.pdb
?????文件?????1433165??2015-03-19?19:26??xyz-enu批量\GG.txt
?????文件?????1463659??2015-03-19?19:29??xyz-enu批量\GGBB.txt
?????文件????????1959??2015-03-19?19:24??xyz-enu批量\main.cpp
?????文件????????2797??2015-03-19?19:24??xyz-enu批量\Matrix.cpp
?????文件?????????595??2015-03-19?19:24??xyz-enu批量\Matrix.h
?????文件????????4488??2015-03-19?19:24??xyz-enu批量\Precession.dsp
?????文件?????????528??2015-03-19?19:24??xyz-enu批量\Precession.dsw
?????文件???????58368??2015-03-19?19:24??xyz-enu批量\Precession.ncb
?????文件???????54784??2015-03-19?19:24??xyz-enu批量\Precession.opt
?????文件????????1331??2015-03-19?19:24??xyz-enu批量\Precession.plg