首页 > 代码库 > GPS坐标 转 ECEF地球坐标
GPS坐标 转 ECEF地球坐标
#include "stdafx.h"
#include <math.h>
#define PI 3.14159
/*
该程序主要是实现从GPS坐标转换为地球的三维坐标的函数
*/
void GPS2ECEF(double latitude, double longitude, double height, double &X, double &Y, double &Z)
{
double a = 6378137;
double b = 6356752.314245;
double E = (a*a - b*b)/(a*a);
double COSLAT = cos(latitude*PI/180);
double SINLAT = sin(latitude*PI/180);
double COSLONG = cos(longitude*PI/180);
double SINLONG = sin(longitude*PI/180);
double N = a /(sqrt(1 - E*SINLAT*SINLAT));
double NH = N + height;
X = NH * COSLAT * COSLONG;
Y = NH * COSLAT * SINLONG;
Z = (b*b*N/(a*a) + height) * SINLAT;
}
int _tmain(int argc, _TCHAR* argv[])
{
double latitude = 22.4331034196;
double longitude = 113.3957986107;
double h = 23.3;
double XX = 0.0;
double YY = 0.0;
double ZZ = 0.0;
GPS2ECEF(latitude, longitude, h, XX, YY, ZZ);
return 0;
}
GPS坐标 转 ECEF地球坐标