gps模块的处理

已于 2023-04-04 17:05:49 修改
阅读量403 收藏 3
点赞数
分类专栏： C语言记录 文章标签： 算法
于 2022-12-08 16:17:04 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/weixin_43693705/article/details/128238819
版权

系列文章目录

一.gps出来的数据并不能直接使用，需要通过一点点转换后才能

提示：写完文章后，目录可以自动生成，如何生成可参考右边的帮助文档

#include <stdio.h>
#include <string.h>
#include <stdlib.h>
char lon_str[] = "11329.467276";
char lat_str[] = "2327.041999";


double longitudeToOnenetFormat()
{
  double lon_temp = 0;
  long lon_Onenet = 0;
  int dd_int = 0;
  long mm_int = 0;
  double lon_Onenet_double = 0;

  lon_temp = atof(lon_str);
  lon_Onenet =lon_temp*100000;  //转换为整数

  dd_int = lon_Onenet/10000000; //取出dd

  mm_int = lon_Onenet%10000000;  //取出MM部分


  lon_Onenet_double = dd_int + (double)mm_int/60/100000;//换算为Onenet格式
  return  lon_Onenet_double;
}

double latitudeToOnenetFormat()
{
  double lat_temp = 0;
  long lat_Onenet = 0;
  int dd_int = 0;
  long mm_int = 0;

  double lat_Onenet_double = 0;

  lat_temp = atof(lat_str);
  lat_Onenet =lat_temp*100000;  //转换为整数

  dd_int = lat_Onenet/10000000; //取出dd

  mm_int = lat_Onenet%10000000;  //取出MM部分

  lat_Onenet_double = dd_int + (double)mm_int/60/100000;//换算为Onenet格式
  return  lat_Onenet_double;
}

int main()
{
    printf("%f\n",longitudeToOnenetFormat());
    printf("%f\n",latitudeToOnenetFormat());
    return 0;
}

#include<stdio.h>
#include<math.h>
#include<stdlib.h>
#define PI 3.1415926535897932384626
double* BD09ToWGS84(double, double);
double* WGS84ToBD09(double, double);
double* BD09ToGCJ02(double, double);
double* GCJ02ToBD09(double, double);
double* GCJ02ToWGS84(double, double);
double* WGS84ToGCJ02(double, double);
 
int main(){
	double lon = 116.403988;
	double lat = 39.914266;
	double *p = WGS84ToBD09(lon, lat);
	printf("%.10f, %.10f", p[0], p[1]);
}
// (BD09 <=> WGS84) base on (BD09 <=> GCJ02) and (WGS84 <=> GCJ02)
double* BD09ToWGS84(double lon_BD, double lat_BD){
	double *GCJ = BD09ToGCJ02(lon_BD, lat_BD);
	return GCJ02ToWGS84(GCJ[0], GCJ[1]);
} 
 
double* WGS84ToBD09(double lon_WGS, double lat_WGS){
	double *GCJ = WGS84ToGCJ02(lon_WGS, lat_WGS);
	return GCJ02ToBD09(GCJ[0], GCJ[1]);
} 
 
// BD09 <=> GCJ02
double baiduFactor = (PI * 3000.0) / 180.0;
 
double* BD09ToGCJ02(double lon_BD, double lat_BD){
	double *GCJ = (double *)malloc(2*sizeof(double));
	double x = lon_BD - 0.0065;
	double y = lat_BD - 0.006;
	double z = sqrt(x * x + y * y) - 0.00002 * sin(y * baiduFactor);
	double theta = atan2(y, x) - 0.000003 * cos(x * baiduFactor);
	GCJ[0] = z * cos(theta);
	GCJ[1] = z * sin(theta);
	return GCJ;
}
 
double* GCJ02ToBD09(double lon_GCJ, double lat_GCJ){
	double *BD = (double *)malloc(2*sizeof(double));
	double z = sqrt(lon_GCJ * lon_GCJ + lat_GCJ * lat_GCJ) + 0.00002 * sin(lat_GCJ * baiduFactor);
	double theta = atan2(lat_GCJ, lon_GCJ) + 0.000003 * cos(lon_GCJ * baiduFactor);
	BD[0] = z * cos(theta) + 0.0065;
	BD[1] = z * sin(theta) + 0.006;
	return BD;
} 
 
// WGS84 <=> GCJ02
double a = 6378245;
double ee = 0.006693421622965823;
 
// roughly check whether coordinates are in China.
int isInChinaBbox(double lon, double lat){
  	return lon >= 72.004 && lon <= 137.8347 && lat >= 0.8293 && lat <= 55.8271;
}
 
double transformLat(double x, double y){
	double ret = -100.0 + 2.0 * x + 3.0 * y + 0.2 * y * y + 0.1 * x * y + 0.2 * sqrt(fabs(x));
	ret += ((20.0 * sin(6.0 * x * PI) + 20.0 * sin(2.0 * x * PI)) * 2.0) / 3.0;
	ret += ((20.0 * sin(y * PI) + 40.0 * sin((y / 3.0) * PI)) * 2.0) / 3.0;
	ret += ((160.0 * sin((y / 12.0) * PI) + 320.0 * sin((y * PI) / 30.0)) * 2.0) / 3.0;
	return ret;
}
 
double transformLon(double x, double y){
	double ret = 300.0 + x + 2.0 * y + 0.1 * x * x + 0.1 * x * y + 0.1 * sqrt(fabs(x));
	ret += ((20.0 * sin(6.0 * x * PI) + 20.0 * sin(2.0 * x * PI)) * 2.0) / 3.0;
	ret += ((20.0 * sin(x * PI) + 40.0 * sin((x / 3.0) * PI)) * 2.0) / 3.0;
	ret += ((150.0 * sin((x / 12.0) * PI) + 300.0 * sin((x / 30.0) * PI)) * 2.0) / 3.0;
	return ret;
}
 
double* delta(double lon, double lat){
	double *d = (double *)malloc(2*sizeof(double));
	double dLon = transformLon(lon - 105.0, lat - 35.0);
    double dLat = transformLat(lon - 105.0, lat - 35.0);
	
	double radLat = (lat / 180.0) * PI;
	double magic = sin(radLat);
	
	magic = 1.0 - ee * magic * magic;
	
	double sqrtMagic = sqrt(magic);
	d[0] = (dLon * 180.0) / (a / sqrtMagic * cos(radLat) * PI);
	d[1] = (dLat * 180.0) / ((a * (1.0 - ee)) / (magic * sqrtMagic) * PI);
	return d;
}
 
double* WGS84ToGCJ02(double lon_WGS, double lat_WGS){
	double *GCJ = (double *)malloc(2*sizeof(double));
	if (!isInChinaBbox(lon_WGS, lat_WGS)){
		GCJ[0] = lon_WGS;
		GCJ[1] = lat_WGS;
		return GCJ;
	} 
	double *d = delta(lon_WGS, lat_WGS);
	GCJ[0] = lon_WGS + d[0];
	GCJ[1] = lat_WGS + d[1];
	return GCJ;
}
 
double* GCJ02ToWGS84(double lon_GCJ, double lat_GCJ) {
	double *WGS = (double *)malloc(2*sizeof(double));
	if (!isInChinaBbox(lon_GCJ, lat_GCJ)){
		WGS[0] = lon_GCJ;
		WGS[1] = lat_GCJ;
		return WGS;
	} 
	WGS[0] = lon_GCJ; WGS[1] = lat_GCJ;
	double *temp = WGS84ToGCJ02(WGS[0], WGS[1]);
	double dx = temp[0] - lon_GCJ;
	double dy = temp[1] - lat_GCJ;
	while (fabs(dx) > 1e-6 || fabs(dy) > 1e-6) {
		WGS[0] -= dx;
		WGS[1] -= dy;
		temp = WGS84ToGCJ02(WGS[0], WGS[1]);
		dx = temp[0] - lon_GCJ;
		dy = temp[1] - lat_GCJ;
	}
	return WGS;
}

坐标转换链接: link

前言

提示：这里可以添加本文要记录的大概内容：

例如：随着人工智能的不断发展，机器学习这门技术也越来越重要，很多人都开启了学习机器学习，本文就介绍了机器学习的基础内容。

`
坐标查询网站

http://api.map.baidu.com/lbsapi/getpoint/index.html

整体代码

#include<stdio.h>
#include<math.h>
#include<stdlib.h>
#define PI 3.1415926535897932384626
double* BD09ToWGS84(double, double);
double* WGS84ToBD09(double, double);
double* BD09ToGCJ02(double, double);
double* GCJ02ToBD09(double, double);
double* GCJ02ToWGS84(double, double);
double* WGS84ToGCJ02(double, double);






double lon ;
double lat ;




#include <stdio.h>
#include <string.h>
#include <stdlib.h>
char lon_str[] = "12154.16691545";
char lat_str[] = "3052.37240819";


double longitudeToOnenetFormat()
{
  double lon_temp = 0;
  long lon_Onenet = 0;
  int dd_int = 0;
  long mm_int = 0;
  double lon_Onenet_double = 0;

  lon_temp = atof(lon_str);
  lon_Onenet =lon_temp*100000;  //转换为整数

  dd_int = lon_Onenet/10000000; //取出dd

  mm_int = lon_Onenet%10000000;  //取出MM部分


  lon_Onenet_double = dd_int + (double)mm_int/60/100000;//换算为Onenet格式
  return  lon_Onenet_double;
}

double latitudeToOnenetFormat()
{
  double lat_temp = 0;
  long lat_Onenet = 0;
  int dd_int = 0;
  long mm_int = 0;

  double lat_Onenet_double = 0;

  lat_temp = atof(lat_str);
  lat_Onenet =lat_temp*100000;  //转换为整数

  dd_int = lat_Onenet/10000000; //取出dd

  mm_int = lat_Onenet%10000000;  //取出MM部分

  lat_Onenet_double = dd_int + (double)mm_int/60/100000;//换算为Onenet格式
  return  lat_Onenet_double;
}














int main(){

     lon=longitudeToOnenetFormat() ;
    lat =latitudeToOnenetFormat() ;

	double *p = WGS84ToBD09(lon, lat);
	printf("%.10f, %.10f", p[0], p[1]);
}
// (BD09 <=> WGS84) base on (BD09 <=> GCJ02) and (WGS84 <=> GCJ02)
double* BD09ToWGS84(double lon_BD, double lat_BD){
	double *GCJ = BD09ToGCJ02(lon_BD, lat_BD);
	return GCJ02ToWGS84(GCJ[0], GCJ[1]);
}

double* WGS84ToBD09(double lon_WGS, double lat_WGS){
	double *GCJ = WGS84ToGCJ02(lon_WGS, lat_WGS);
	return GCJ02ToBD09(GCJ[0], GCJ[1]);
}

// BD09 <=> GCJ02
double baiduFactor = (PI * 3000.0) / 180.0;

double* BD09ToGCJ02(double lon_BD, double lat_BD){
	double *GCJ = (double *)malloc(2*sizeof(double));
	double x = lon_BD - 0.0065;
	double y = lat_BD - 0.006;
	double z = sqrt(x * x + y * y) - 0.00002 * sin(y * baiduFactor);
	double theta = atan2(y, x) - 0.000003 * cos(x * baiduFactor);
	GCJ[0] = z * cos(theta);
	GCJ[1] = z * sin(theta);
	return GCJ;
}

double* GCJ02ToBD09(double lon_GCJ, double lat_GCJ){
	double *BD = (double *)malloc(2*sizeof(double));
	double z = sqrt(lon_GCJ * lon_GCJ + lat_GCJ * lat_GCJ) + 0.00002 * sin(lat_GCJ * baiduFactor);
	double theta = atan2(lat_GCJ, lon_GCJ) + 0.000003 * cos(lon_GCJ * baiduFactor);
	BD[0] = z * cos(theta) + 0.0065;
	BD[1] = z * sin(theta) + 0.006;
	return BD;
}

// WGS84 <=> GCJ02
double a = 6378245;
double ee = 0.006693421622965823;

// roughly check whether coordinates are in China.
int isInChinaBbox(double lon, double lat){
  	return lon >= 72.004 && lon <= 137.8347 && lat >= 0.8293 && lat <= 55.8271;
}

double transformLat(double x, double y){
	double ret = -100.0 + 2.0 * x + 3.0 * y + 0.2 * y * y + 0.1 * x * y + 0.2 * sqrt(fabs(x));
	ret += ((20.0 * sin(6.0 * x * PI) + 20.0 * sin(2.0 * x * PI)) * 2.0) / 3.0;
	ret += ((20.0 * sin(y * PI) + 40.0 * sin((y / 3.0) * PI)) * 2.0) / 3.0;
	ret += ((160.0 * sin((y / 12.0) * PI) + 320.0 * sin((y * PI) / 30.0)) * 2.0) / 3.0;
	return ret;
}

double transformLon(double x, double y){
	double ret = 300.0 + x + 2.0 * y + 0.1 * x * x + 0.1 * x * y + 0.1 * sqrt(fabs(x));
	ret += ((20.0 * sin(6.0 * x * PI) + 20.0 * sin(2.0 * x * PI)) * 2.0) / 3.0;
	ret += ((20.0 * sin(x * PI) + 40.0 * sin((x / 3.0) * PI)) * 2.0) / 3.0;
	ret += ((150.0 * sin((x / 12.0) * PI) + 300.0 * sin((x / 30.0) * PI)) * 2.0) / 3.0;
	return ret;
}

double* delta(double lon, double lat){
	double *d = (double *)malloc(2*sizeof(double));
	double dLon = transformLon(lon - 105.0, lat - 35.0);
    double dLat = transformLat(lon - 105.0, lat - 35.0);

	double radLat = (lat / 180.0) * PI;
	double magic = sin(radLat);

	magic = 1.0 - ee * magic * magic;

	double sqrtMagic = sqrt(magic);
	d[0] = (dLon * 180.0) / (a / sqrtMagic * cos(radLat) * PI);
	d[1] = (dLat * 180.0) / ((a * (1.0 - ee)) / (magic * sqrtMagic) * PI);
	return d;
}

double* WGS84ToGCJ02(double lon_WGS, double lat_WGS){
	double *GCJ = (double *)malloc(2*sizeof(double));
	if (!isInChinaBbox(lon_WGS, lat_WGS)){
		GCJ[0] = lon_WGS;
		GCJ[1] = lat_WGS;
		return GCJ;
	}
	double *d = delta(lon_WGS, lat_WGS);
	GCJ[0] = lon_WGS + d[0];
	GCJ[1] = lat_WGS + d[1];
	return GCJ;
}

double* GCJ02ToWGS84(double lon_GCJ, double lat_GCJ) {
	double *WGS = (double *)malloc(2*sizeof(double));
	if (!isInChinaBbox(lon_GCJ, lat_GCJ)){
		WGS[0] = lon_GCJ;
		WGS[1] = lat_GCJ;
		return WGS;
	}
	WGS[0] = lon_GCJ; WGS[1] = lat_GCJ;
	double *temp = WGS84ToGCJ02(WGS[0], WGS[1]);
	double dx = temp[0] - lon_GCJ;
	double dy = temp[1] - lat_GCJ;
	while (fabs(dx) > 1e-6 || fabs(dy) > 1e-6) {
		WGS[0] -= dx;
		WGS[1] -= dy;
		temp = WGS84ToGCJ02(WGS[0], WGS[1]);
		dx = temp[0] - lon_GCJ;
		dy = temp[1] - lat_GCJ;
	}
	return WGS;
}

2.判断两GPS距离跟方位


#define _PI 3.1415926
#define PI_180 0.01745329   //pi/180  角度转弧度
#define Earth_R 6372.795477598


void  getDistanceBearing(double StartLat,double StartLng,double EndLat,double EndLng,double* dis,double* bearing)
{
    //Fai对应纬度 Lat，temp对应经度 lon
    double Fai1 = StartLat * PI_180;
    double Fai2 = EndLat * PI_180;
    double temp = (EndLng - StartLng) * PI_180;

    *dis = Earth_R * acos(sin(Fai1) * sin(Fai2) + cos(Fai1)*cos(Fai2)*cos(temp)) * 1000;//已经换算成m了
    *bearing = atan2(sin(temp)*cos(Fai2),cos(Fai1)*sin(Fai2)-sin(Fai1)*cos(Fai2)*cos(temp))/PI_180;//弧度
	if(*bearing < 0)
		*bearing += 360;

}
童独秀
关注
  • 0
    点赞
  • 踩
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
专栏目录
解析GPS模块数据的代码程序
10-14
本代码是处理从GPS模块接受的数据，有完整的分析处理GPS原始数据的测试代码。
C#实现GPS定位(Windows mobile)
11-19
自己看吧！串口是COM4 波特率是4800 对应自己的机器自己改一下吧！
单片机处理GPS模块信息
nikyoung的博客
01-18 1223
如果我们假设地球是一个完美的球体，那么它的半径就是地球的平均半径，记为R。设第一点A的经 纬度为(LonA, LatA)，第二点B的经纬度为(LonB, LatB)，按照0度经线的基准，东经取经度的正值(Longitude)，西经取经度负值(-Longitude)，北纬取90-纬度值(90- Latitude)，南纬取90+纬度值(90+Latitude)，则经过上述处理过后的两点被计为(MLonA, MLatA)和(MLonB, MLatB)。Pi/180也就是：C=sin(LatA/57.2958)
GPS数据处理
qq_24429681的博客
01-18 4321
GPS数据转换，GPS数据查询，GPS坐标转换
用C＃读取GPS数据的基类，适用于wince操作系统。 适合自带GPS模块的PDA或智能手机的设备
专栏
06-05 910
在多普达p800 , windows Mobile 5.0 操作系统下测试通过.  using System; using System.Runtime.InteropServices; using System.Text; namespace BaseStationPDA  {  class GPS   {   public string PortNum;
GPS.rar_GPS_GPS模块_gps 数据处理_导航电文_数据处理
09-24
本资源包“GPS.rar”包含了与GPS模块、GPS数据处理以及导航电文相关的知识和源码，有助于我们理解和开发基于GPS的应用。 首先，我们要理解GPS模块的工作原理。GPS模块通过接收至少四颗卫星发射的信号，利用这些信号...
51单片机+gps模块提取数据并通过串口返回处理后的数据
07-21
51单片机+gps模块提取数据并通过串口返回处理后的数据 注意波特率是否一致 提取后的数据格式uchar code Weidu[] = "weidu is:"; uchar code Jingdu[] = "jingdu is:"; uchar code UTCTime[] = "UTCshijian is:"; ...
GPS模块原理图.rar
09-10
GPS模块是一种用于接收全球定位系统（GPS）卫星信号的设备，它能够计算并提供地理位置、时间等信息。在电子工程和物联网应用中，GPS模块扮演着至关重要的角色。本资料"GPS模块原理图.rar"包含了一份详细的GPS模块...
GPS.zip_51单片机GPS_GPS_gps模块 单片机_单片机gps模块_自制gps模块
07-14
4. **程序设计**：编写在51单片机上的程序，如何读取GPS模块的数据，处理并显示地理位置信息。 5. **硬件连接**：GPS模块的电源需求、GPIO引脚连接，以及天线的安装和选择。 6. **调试技巧**：如何使用串口助手...
GPS模块源码及资料
07-22
本资源包包含了GPS模块相关的源码和资料，主要聚焦于JY901和ATK-NEO-6M两个型号的模块。以下是对这些内容的详细解释： 1. **JY901 GPS模块**： JY901是一款小型、低功耗的GPS模块，广泛应用于各种移动设备和物联网...
C#串口获取GPS信息
05-19
C#写的获取GPS信息，通过串口获取经度，纬度，海拔，还可以通过文本框实时显示GPS收到的信息。
gps开发模块
01-21
ublox-gps硬件开发，学习GPS信号接收及预处理，导航定位
串口通信学习（GPS模块）2021.5.10
I have a dream, here my dreams come true!
05-10 6963
GPS串口通信实践 2021.5.71、串口通信简介二级目录三级目录2、GPS模块串口通信实践2.1 驱动安装2.2 插入GPS模块2.3 Eclipse编写Java串口通信代码 1、串口通信简介 二级目录 三级目录 2、GPS模块串口通信实践 2.1 驱动安装 2.2 插入GPS模块         将GPS模块的usb接口插入到电脑的usb接口上，电脑右下方会提示成功安装了设备驱动程序，同时在电脑->设备
GPS模块资料集锦
左霖风的博客
09-07 1124
1、GNNS卫星协议分析 2、GPS数据包格式及数据包解析 3、GPS北斗双模技术应用开发研究–数据解析
GPS模块实验
习惯就好zz的专栏
03-17 1100
串口读取gps数据
卫星定位导航|GPS定位模块，北斗定位模块的应用场景及选型建议
小分享
03-10 2922
基于高精度定位模块的智慧旅游高精度定位解决方案，利用高精度定位技术，实时获取和显示大规模游客群的位置，分析热点区域人口密度及分布，及时进行调节、控制、疏导客流，推送预警信息、引导路线、车辆信息等，实时在线提供周边环境查询、多媒体导览、地图定位等内容；天工测控(SKYLAB)是一家致力于GNSS模块、WiFi模块、蓝牙模块、UWB模块及无线通信应用方案的产品全球供应商，GNSS定位模块参数对比表中提到的GNSS模块均已批量供货，更多GNSS模块参数特性可直接访问SKYLAB官网或阿里店铺。
Arduino模块学习笔记（一）—GPS模块的使用
ArsenLupin的博客
11-29 8270
本文通过Arduino UNO开发板使用现有的GPS模块，并对采集来的GPS标准协议NMEA信息进行提取和解码，得到最终所需的位置信息。
linux libgps dev,libgps C代码示例
weixin_34177886的博客
05-16 231
我说得太早了.在浏览了其他SO问题后,我遇到了this完全不相关的问题.这是我的略微修改版本：#include #include #include #include #include int main() {int rc;struct timeval tv;struct gps_data_t gps_data;if ((rc = gps_open("localhost", "2947", &amp...
Leetcode42接雨水（单调栈）
最新发布
AGNING的博客
08-28 396
维护一个栈，满足从栈底到栈顶元素大小递减。如果当前元素高于栈顶，且栈内有至少2个元素，则形成了一个凹槽，及一个图中横着的红色矩形，将它的面积累加即可，第一次写难在维护单调栈中计算面积和。求出前缀最大和后缀最大，用两者较小值减去当前高度，累加即可，这个思路容易想到，这里不赘述。
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值