文档章节

坐标转换

洋碱
 洋碱
发布于 2017/08/27 16:31
字数 993
阅读 30
收藏 0

坐标转换源代码--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);

}
 


 

本文转载自:

共有 人打赏支持
上一篇: 关于npm install
下一篇: C# 实现UPD 协议
洋碱

洋碱

粉丝 3
博文 65
码字总数 26002
作品 0
广州
高级程序员
私信 提问
iOS开发中的火星坐标系及各种坐标系转换算法

其原理是这样的:保密局开发了一个系统,能将实际的坐标转换成虚拟的坐标。所有在中国销售的数字地图必须使用这个系统进行坐标转换之后方可上市。这是生产环节,这种电子地图被称为火星地图。...

刀客445
2016/02/23
1K
1
百度地图的坐标(北斗与GPS)转换问题

先声明,这里的坐标转换api是JS交互的。 看过百度地图api的童鞋知道有个方法,可以将北斗或GPS的坐标转换为百度地图的球面坐标。 方法名称为:BMap.Convertor.translate(point,0,translateC...

大海月升
2013/04/09
0
2
GDAL影像投影转换

GDAL影像投影转换 又有一段时间没有写博客了,今天就把影像(DEM/遥感影像等)投影转换的经验和大家分享下。那么关于GDAL影像投影转换的文章在网上可以说是有很多,如果你还不清楚地图投影那...

长平狐
2013/12/25
745
0
【Cocos2d-x】开发基础-Cocos2d-x坐标系

本篇博客讲解: 1.UI坐标 2.OpenGL坐标 3.世界坐标和模型坐标 4.实例:世界坐标转换为模型坐标 5.实例:模型坐标转换为世界坐标 UI坐标和OpenGL坐标 UI坐标就是Android和iOS等应用开发的时候使...

qq_26525215
2017/07/01
0
0
经纬度转换地图坐标api示例代码

经纬度转换地图坐标api支持百度、谷歌、GPS三大经纬度互相转化。 基于php的经纬度转换地图坐标api调用代码实例 <!--?php// +------------------------------------------------------------...

夜晚晚
2016/03/31
114
0

没有更多内容

加载失败,请刷新页面

加载更多

错误: 找不到或无法加载主类

在IDEA的使用过程中,经常断掉服务或者重启服务,最近断掉服务重启时突然遇到了一个启动报错: 错误:找不到或无法加载主类 猜测:1,未能成功编译; 尝试:菜单---》Build---》Rebuild Pro...

安小乐
12分钟前
1
0
vue路由传参,刷新页面,引发的bug

最近遇到一个bug 通过vue路由跳转到页面, 然后接参控制(v-if ),成功显示 而刷新页面,显示失败。 苦苦地找了半天原因,打印参数发现正确,再打印下类型......,路由跳过来会保持传参时的...

hanbb
13分钟前
0
0
【58沈剑 架构师之路】InnoDB,select为啥会阻塞insert?

MySQL的InnoDB的细粒度行锁,是它最吸引人的特性之一。 但是,如《InnoDB,5项最佳实践》所述,如果查询没有命中索引,也将退化为表锁。 InnoDB的细粒度锁,是实现在索引记录上的。 一,Inn...

张锦飞
16分钟前
0
0
冒泡,选择和插入排序比较

/** * 冒泡排序,两层嵌套循环,内层局部比较后,找出最大或者最小数据并交换数据,使其局部有序,外层用于比较剩余元素,相较于选择排序,选择排序相当于是冒泡的一个优化版本(减少了交换...

strict_nerd
17分钟前
0
0
html内联(行内)元素、块级(块状)元素和行内块元素分类

HTML可以将元素分类方式分为内联(行内)元素、块级(块状)元素和行内块元素三种。 注:HTML是标签语言,那么既然是标签,就可以自己定义一些自己元素(如<wode>自定义的元素</wode>等),自...

NB-One
23分钟前
1
0

没有更多内容

加载失败,请刷新页面

加载更多

返回顶部
顶部