Halibaba

  博客园 :: 首页 :: 博问 :: 闪存 :: 新随笔 :: 联系 :: 订阅 订阅 :: 管理 ::

//坐标转换源代码--GPS定位程序(C++) //GPS数据处理中为了满足不同的需要,处理的数据要进行坐标转换,得到在不同坐标系统下的结果,下面是笛卡尔坐标系,大地坐标系,站心地平坐标系(线型和极坐标形式)之间的转换源代码:

//头文件:

#ifndef _COORDCOVERT_H #define _COORDCOVERT_H

#include "stdlib.h" //WGS-84椭球体参数 const double a=6378137.0;//长半轴 const double flattening=1/298.257223563;//扁率 const double delta=0.0000001;

typedef struct tagCRDCARTESIAN{  double x;  double y;  double z; }CRDCARTESIAN;

typedef CRDCARTESIAN *PCRDCARTESIAN; //笛卡尔坐标系

typedef struct tagCRDGEODETIC{  double longitude;  double latitude;  double height; }CRDGEODETIC;

typedef CRDGEODETIC *PCRDGEODETIC; //大地坐标系

typedef struct tagCRDTOPOCENTRIC{  double northing;  double easting;  double upping; }CRDTOPOCENTRIC;

typedef CRDTOPOCENTRIC *PCRDTOPOCENTRIC; //站心地平坐标系(线坐标形式)

typedef struct tagCRDTOPOCENTRICPOLAR{  double range;  double azimuth;  double elevation; }CRDTOPOCENTRICPOLAR;

typedef CRDTOPOCENTRICPOLAR *PCRDTOPOCENTRICPOLAR; //站心地平坐标系(极坐标形式)

//由笛卡尔坐标转换为大地坐标 void CartesianToGeodetic (PCRDGEODETIC pcg, PCRDCARTESIAN pcc,         double dSemiMajorAxis, double dFlattening); //pcg:指向所转换出的大地坐标的指针; //pcc:指向待转换的笛卡尔坐标的指针; //dSemiMajorAxis:参考椭球的长半轴; //dFlattening:参考椭球的扁率。

//由大地坐标转换为笛卡尔坐标 void GeodeticToCartesian (PCRDCARTESIAN pcc, PCRDGEODETIC pcg,         double dSemiMajorAxis, double dFlattening); //pcc:指向所转换出的笛卡尔坐标的指针; //pcg:指向待转换的大地坐标的指针; //dSemiMajorAxis:参考椭球的长半轴; //dFlattening:参考椭球的扁率。

//由笛卡尔坐标转换为站心地平坐标 void CartesianToTopocentric (PCRDTOPOCENTRIC pct,         PCRDCARTESIAN pcc,         PCRDCARTESIAN pccCenter,         double dSemiMajorAxis,         double dFlattening); //pct:指向所转换出的站心地平坐标的指针; //pcc:指向待转换的笛卡尔坐标的指针; //pccCenter:指向站心的笛卡尔坐标的指针; //dSemiMajorAxis:参考椭球的长半轴; //dFlattening:参考椭球的扁率。

//由站心地平直角坐标转换为站心地平极坐标 void TopocentricToTopocentricPolar (PCRDTOPOCENTRICPOLAR pctp,          PCRDTOPOCENTRIC pct); //pctp:指向所转换出的站心地平极坐标的指针; //pct:指向待转换的站心地平坐标的指针;

//由站心地平极坐标转换为站心地平直角坐标 void TopocentricPolarToTopocentric (PCRDTOPOCENTRIC pct,PCRDTOPOCENTRICPOLAR pctp); //pct:指向所转换的站心地平坐标的指针; //pctp:指向待转换的站心地平极坐标的指针;

#endif

********源文件***************************************************************

#include "CoordCovert.h" #include "math.h"

void CartesianToGeodetic (PCRDGEODETIC pcg, PCRDCARTESIAN pcc,         double dSemiMajorAxis, double dFlattening) {  double e2;//第一偏心率的平方  e2=2*dFlattening-dFlattening*dFlattening;

 pcg->longitude=atan(pcc->y/pcc->x);  double W,N,N1=0,B,B1;  B1=atan(pcc->z/sqrt(pcc->x*pcc->x+pcc->y*pcc->y));  while(1)  {   W=sqrt(1-e2*sin(B1)*sin(B1));   N1=dSemiMajorAxis/W;   B=atan((pcc->z+N1*e2*sin(B1))/sqrt(pcc->x*pcc->x+pcc->y*pcc->y));

  if(fabs(B-B1)<delta)    break;   else    B1=B;  }

 pcg->latitude=B;  N=dSemiMajorAxis/sqrt(1-e2*sin(pcg->latitude)*sin(pcg->latitude));  pcg->height=sqrt(pcc->x*pcc->x+pcc->y*pcc->y)/cos(B)-N;

}

//由大地坐标转换为笛卡尔坐标 void GeodeticToCartesian (PCRDCARTESIAN pcc, PCRDGEODETIC pcg,         double dSemiMajorAxis, double dFlattening) {  double e2;//第一偏心率的平方  double N;//卯酉圈半径  e2=2*dFlattening-dFlattening*dFlattening;  N=dSemiMajorAxis/sqrt(1-e2*sin(pcg->latitude)*sin(pcg->latitude));

 pcc->x=(N+pcg->height)*cos(pcg->latitude)*cos(pcg->longitude);  pcc->y=(N+pcg->height)*cos(pcg->latitude)*sin(pcg->longitude);  pcc->z=(N*(1-e2)+pcg->height)*sin(pcg->latitude);

}

//由笛卡尔坐标转换为站心地平坐标 void CartesianToTopocentric (PCRDTOPOCENTRIC pct,         PCRDCARTESIAN pcc,         PCRDCARTESIAN pccCenter,         double dSemiMajorAxis,         double dFlattening) {  double dx,dy,dz;  dx=pcc->x-pccCenter->x;  dy=pcc->y-pccCenter->y;  dz=pcc->z-pccCenter->z;

 PCRDGEODETIC pd;  pd=(PCRDGEODETIC)malloc(sizeof(CRDGEODETIC));

 CartesianToGeodetic (pd,pccCenter,dSemiMajorAxis,dFlattening);

 pct->northing=-sin(pd->latitude)*cos(pd->longitude)*dx   -sin(pd->latitude)*sin(pd->longitude)*dy   +cos(pd->latitude)*dz;  pct->easting=-sin(pd->longitude)*dx   +cos(pd->longitude)*dy;  pct->upping=cos(pd->latitude)*cos(pd->longitude)*dx   +cos(pd->latitude)*sin(pd->longitude)*dy   +sin(pd->latitude)*dz;  free(pd);

}

//由站心地平直角坐标转换为站心地平极坐标 void TopocentricToTopocentricPolar (PCRDTOPOCENTRICPOLAR pctp,          PCRDTOPOCENTRIC pct) {

 pctp->range=sqrt(pct->northing*pct->northing+pct->easting*pct->easting+pct->upping*pct->upping);  pctp->azimuth=atan(pct->easting/pct->northing);  pctp->elevation=asin(pct->upping/pctp->range);

}

//由站心地平极坐标转换为站心地平直角坐标 void TopocentricPolarToTopocentric (PCRDTOPOCENTRIC pct,          PCRDTOPOCENTRICPOLAR pctp) {  pct->northing=pctp->range*cos(pctp->elevation)*cos(pctp->azimuth);  pct->easting=pctp->range*cos(pctp->elevation)*sin(pctp->azimuth);  pct->upping=pctp->range*sin(pctp->elevation);

}

 

 

 

posted on 2014-02-18 19:51  Halibaba  阅读(625)  评论(0编辑  收藏  举报