【安信可A9G专题④】A9G模块/开发板GPS定位注意事项 && 坐标系转换

2020-10-12 15:02:49 513 收藏 1
分类专栏： 安信可 A9G 文章标签： GPS 坐标系转换 WGS-84 GCJ-02 BD-09
最后发布:2020-10-12 15:02:49首次发布:2020-10-12 15:02:49
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/Boantong_/article/details/109001737
版权

本系列博客学习由 安信可科技 - 官方博客 技术分享，如有疑问请留言或联系邮箱。

一、前言

    最近不少朋友说用我们的A9G模块GPS定位不准，有的反馈说偏差几百米，有点甚至反馈说偏差一公里，那么问题出在哪里呢，真相只有一个，那就是你用的姿势不对。
本文将着重介绍如何正确使用A9G定位。

在这里插入图片描述

二、正确姿势：

  1. 造成设备GPS定位偏差大的一个原因是定位时把设备放在了室内，室内定位是不准确的，使用设备定位时一定要放在室外空旷区域，重要的事情说三遍 ，放到室外！放到室外！放到室外！
  2. GPS输出的原始信息格式为NMEA标准，比如坐标(2236.3934,11350.3831)表示(22度36.3934分，113度50.3831分)，转换成度：(22.606557°，113.839718°)，1度=60分。有的朋友没有把度分转换为度直接在地图软件上搜索发现偏差大得离谱，或者没有按照1度=60分来转换导致偏差很大
  3. 在使用定位坐标显示到地图上时，注意坐标的转换，模组输出的位置是WGS84坐标，如果使用百度地图，需要转换成BD-09坐标，如果使用的腾讯地图、高德地图、google地图国内版等，请先转换到GCJ-02坐标（火星坐标），否则显示结果可能会产生巨大误差。
    在这里插入图片描述

三、WGS84、GCJ02、BD09之间的相互转换

1.使用在线转换工具
2.代码实现（仅供参考）

#include <stdio.h>
#include <math.h>
 
/*
 pi: 圆周率。
 a: 卫星椭球坐标投影到平面地图坐标系的投影因子。
 ee: 椭球的偏心率。
 x_pi: 圆周率转换量。
*/
 
double pi = 3.14159265358979324;		
double a = 6378245.0;
double ee = 0.00669342162296594323;
double x_pi = 3.14159265358979324 * 3000.0 / 180.0;
 
int wgs2bd(double lat, double lon, double* pLat, double* pLon); // WGS84=>BD09 地球坐标系=>百度坐标系 
int gcj2bd(double lat, double lon, double* pLat, double* pLon);	// GCJ02=>BD09 火星坐标系=>百度坐标系 
int bd2gcj(double lat, double lon, double* pLat, double* pLon);	// BD09=>GCJ02 百度坐标系=>火星坐标系 
int wgs2gcj(double lat, double lon, double* pLat, double* pLon);// WGS84=>GCJ02 地球坐标系=>火星坐标系
int gcj2wgs(double lat, double lon, double* pLat, double* pLon);// GCJ02=>WGS84 火星坐标系=>地球坐标系(粗略)
int bd2wgs(double lat, double lon, double* pLat, double* pLon);	// BD09=>WGS84 百度坐标系=>地球坐标系(粗略)
int gcj2wgs_Exactly(double lat, double lon, double* wgs_Lat, double* wgs_lon);// GCJ02=>WGS84 火星坐标系=>地球坐标系（精确）
int bd2wgs_Exactly(double lat, double lon, double* pLat, double* pLon);// BD09=>WGS84 百度坐标系=>地球坐标系(精确)
double *OffSet(double lat, double lon);	// 偏移量
double transformLat(double x, double y);// 纬度偏移量
double transformLon(double x, double y);// 经度偏移量
int outOfChina(double lat, double lon);

// WGS84=>BD09 地球坐标系=>百度坐标系 
int wgs2bd(double lat, double lon, double* pLat, double* pLon) {
   double lat_ = 0.0, lon_ = 0.0;
   wgs2gcj(lat, lon, &lat_, &lon_);
   gcj2bd(lat_, lon_,  pLat, pLon);
   return 0;
}
 
// GCJ02=>BD09 火星坐标系=>百度坐标系 
int gcj2bd(double lat, double lon, double* pLat, double* pLon) {
   double x = lon, y = lat;
   double z = sqrt(x * x + y * y) + 0.00002 * sin(y * x_pi);
   double theta = atan2(y, x) + 0.000003 * cos(x * x_pi);
   *pLon = z * cos(theta) + 0.0065;
   *pLat = z * sin(theta) + 0.006;
   return 0;
}
 
// BD09=>GCJ02 百度坐标系=>火星坐标系 
int bd2gcj(double lat, double lon, double* pLat, double* pLon) {
   double x = lon - 0.0065, y = lat - 0.006;
   double z = sqrt(x * x + y * y) - 0.00002 * sin(y * x_pi);
   double theta = atan2(y, x) - 0.000003 * cos(x * x_pi);
   *pLon = z * cos(theta);
   *pLat = z * sin(theta);
   return 0;
}
 
// WGS84=>GCJ02 地球坐标系=>火星坐标系
int wgs2gcj(double lat, double lon, double* pLat, double* pLon) {
		double dLat,dLon,radLat,magic,sqrtMagic;
    if (outOfChina(lat,lon))
    {
        *pLat = lat;
        *pLon = lon;
        return 0;
    }
   dLat = transformLat(lon - 105.0, lat - 35.0);
   dLon = transformLon(lon - 105.0, lat - 35.0);
   radLat = lat / 180.0 * pi;
   magic = sin(radLat);
   magic = 1 - ee * magic * magic;
   sqrtMagic = sqrt(magic);
   dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * pi);
   dLon = (dLon * 180.0) / (a / sqrtMagic * cos(radLat) * pi);
   *pLat = lat + dLat;
   *pLon = lon + dLon;
   return 0;
}
 
// GCJ02=>WGS84 火星坐标系=>地球坐标系(粗略)
int gcj2wgs(double lat, double lon, double* pLat, double* pLon) {
		double *offset;
    if (outOfChina(lat,lon))
    {
        *pLat = lat;
        *pLon = lon;
        return 0;
    }
	offset = OffSet(lat,lon);
	*pLat = lat - offset[0];
 	*pLon = lon - offset[1];
	return 0;
}
 
// GCJ02=>WGS84 火星坐标系=>地球坐标系（精确）
int gcj2wgs_Exactly(double gcjlat, double gcjlon, double* wgs_Lat, double* wgs_lon) {
	double initDelta,threshold,dLat,mLat,pLat,wgsLat,dLon,mLon,pLon,wgslon,i,newgcjlat,newgcjlon;
    if (outOfChina(gcjlat,gcjlon))
    {
        *wgs_Lat = gcjlat;
        *wgs_lon = gcjlon;
        return 0;
    }
  initDelta = 0.01;
  threshold = 0.000000001;
	dLat = initDelta; 
	dLon = initDelta;
	mLat = gcjlat - dLat;
	mLon = gcjlon - dLon;
	pLat = gcjlat + dLat;
	pLon = gcjlon + dLon;
	wgsLat = 0.0;
	wgslon = 0.0; 
	i = 0.0 ;
	newgcjlat = 0.0;
	newgcjlon = 0.0;
 
	while (1) {
		wgsLat = (mLat + pLat) / 2;
		wgslon = (mLon + pLon) / 2;		
		wgs2gcj(wgsLat,wgslon,&newgcjlat,&newgcjlon);
		dLon = newgcjlon - gcjlon;
		dLat = newgcjlat - gcjlat;
		if ((fabs(dLat) < threshold) && (fabs(dLon) < threshold))
			break;
							
		if (dLat > 0)
			pLat = wgsLat;
		else
			mLat = wgsLat;
		if (dLon > 0)
			pLon = wgslon;
		else
			mLon = wgslon;
 
		if (++i > 10000)
			break;
	}
	*wgs_Lat = wgsLat;
	*wgs_lon = wgslon;
	return 0;
}
 
// BD09=>WGS84 百度坐标系=>地球坐标系(粗略)
int bd2wgs(double lat, double lon, double* pLat, double* pLon) {
	double lat_ = 0.0, lon_ = 0.0;
 	bd2gcj(lat, lon, &lat_, &lon_);
 	gcj2wgs(lat_, lon_,  pLat, pLon);
 	return 0;
}
 
// BD09=>WGS84 百度坐标系=>地球坐标系(精确)
int bd2wgs_Exactly(double lat, double lon, double* pLat, double* pLon) {
	double lat_ = 0.0, lon_ = 0.0;
 	bd2gcj(lat, lon, &lat_, &lon_);
 	gcj2wgs_Exactly(lat_, lon_,  pLat, pLon);
 	return 0;
}
 
 
 
// 偏移量
double *OffSet(double lat, double lon) {
				double sqrtMagic ;
        double Latlon[2] = {0.0,0.0};
        double dLat = transformLat(lon - 105.0, lat - 35.0);
        double dLon = transformLon(lon - 105.0, lat - 35.0);
        double radLat = lat / 180.0 * pi;
        double magic = sin(radLat);
        magic = 1 - ee * magic * magic;
        sqrtMagic = sqrt(magic);
        dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * pi);
        dLon = (dLon * 180.0) / (a / sqrtMagic * cos(radLat) * pi);
		Latlon[0] = dLat;
		Latlon[1] = dLon;
		return Latlon;
	}
 
// 纬度偏移量
double transformLat(double x, double y) {
       double ret = 0.0;
       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 * sin(y * pi  / 30.0)) * 2.0 / 3.0;
       return ret;
}
 
// 经度偏移量
double transformLon(double x, double y) {
       double ret = 0.0;
       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;
}
 
 
 
/**
 * Description: 中国境外返回true,境内返回false
 * @param lon 	经度
 * @param lat	纬度
 * @return
 */
int outOfChina(double lat, double lon) {
    if (lon < 72.004 || lon > 137.8347)
        return 1;
    if (lat < 0.8293 || lat > 55.8271)
        return 1;
    return 0;
}
 
 
/*
WGS84坐标系	113.840998,22.602656
GCJ02坐标系	113.845967,22.599666
BD09坐标系	113.852426,22.605972
*/
int main()
{
	double	lat,lon,newlat,newlon;
//	uart_init(115200);//根据具体MCU初始化串口打印
#if 1	//WGS84转其他测试 
	lon=113.840998;
	lat= 22.602656;
//	double	newlat,newlon;
	printf("-------------------------------------------\r\n"); 
	printf("WGS84: lon=%lf,lat=%lf\r\n",lon,lat);
	printf("-------------------------------------------\r\n"); 
	
	if(wgs2gcj(lat,lon,&newlat,&newlon)==0)    //WGS84坐标转GCJ02坐标 
		printf("GCJ02: lon=%lf,lat=%lf\r\n",newlon,newlat);
		
	printf("-------------------------------------------\r\n"); 

	if(wgs2bd(lat,lon,&newlat,&newlon)==0)		//WGS84坐标转BD09坐标
		printf("BD09:  lon=%lf,lat=%lf\r\n",newlon,newlat);
		
	printf("-------------------------------------------\r\n\r\n\r\n"); 
#endif
 
#if 1	//GCJ02转其他测试 
	lon= 113.845967;
	lat=  22.599666;
	printf("-------------------------------------------\r\n"); 
	printf("GCJ02: lon=%lf,lat=%lf\r\n",lon,lat);
	printf("-------------------------------------------\r\n"); 
	
	if(gcj2bd(lat,lon,&newlat,&newlon)==0)	//GCJ02坐标转BD09坐标 
		printf("BD09:  lon=%lf,lat=%lf\r\n",newlon,newlat);
			
	printf("-------------------------------------------\r\n"); 
	
	if(gcj2wgs_Exactly(lat,lon,&newlat,&newlon)==0)//GCJ02坐标转WGS84坐标
		printf("WGS84: lon=%lf,lat=%lf\r\n",newlon,newlat);
	
	printf("-------------------------------------------\r\n\r\n\r\n"); 	
#endif
 
#if 1	//BD09转其他测试 
	lon= 113.852426;
	lat=  22.605972;
	printf("-------------------------------------------\r\n"); 
	printf("BD09:  lon=%lf,lat=%lf\r\n",lon,lat);
	printf("-------------------------------------------\r\n"); 
	
	if(bd2gcj(lat,lon,&newlat,&newlon)==0)//BD09坐标转GCJ02坐标 
		printf("GCJ02: lon=%lf,lat=%lf\r\n",newlon,newlat);
				
	printf("-------------------------------------------\r\n"); 
	
	if(bd2wgs_Exactly(lat,lon,&newlat,&newlon)==0)//BD09坐标转WGS84坐标
		printf("WGS84: lon=%lf,lat=%lf\r\n",newlon,newlat);
					
	printf("-------------------------------------------\r\n"); 	
#endif	
		
	while(1);
}

本文参考：https://blog.csdn.net/cxw312864660/article/details/106844825/

官方文档资料：https://docs.ai-thinker.com/gprs

  • 共勉！有疑问请留言，或邮箱：support@aithinker.com
还能输入1000个字符 “速评一下”
安信可博客导航一站式搜索(所有博客的汇总帖)
04-21 2343
安信可博客导航一站式搜索(所有博客的汇总帖)文章目录安信可博客导航一站式搜索(所有博客的汇总帖)开源团队简介安信可优势ESP系列IDE开发环境搭建ESP8266模组专题ESP32模组专题蓝牙模组专题泰凌微方案洛达方案LORA模组专题A9G专题瑞昱模组专题RTL871x系列(PS：以上专题对外线上的一部分，更多的技术支持联系我)开源团队简介负责人： 徐宏组员： 苏法成，张鹏，黄方可，谢一易...
【安信可PB-01/02模组专题③】ESP32-G WIFI蓝牙网关与PB02模组开发进行组网通讯
11-21 140
文章目录前言前言最近同事给了一个ESP32-G 蓝牙网关，听说能和
【安信可A9G专题⑤】A9G模组AT指令MQTT接入阿里云实现APP控制
11-19 253
本系列博客学习由 安信可科技 - 官方博客 技术分享，如有疑问请留言或联系邮箱。1、A9G环境在windows上搭建并编译，串口打印 Hello GPRS2、A9G在微信公众号上的定位功能笔记分享;3、安信可A9G模块连接机智云APP教程;4、A9G模块/开发板GPS定位注意事项 && 坐标系转换5、A9G模组AT指令MQTT接入阿里云实现APP控制文章目录一、前言二、创建产品三、MQTT接入一、前言二、创建产品创建蜂窝选择设备面板三、MQTT接入AT+CGA.
ESP32 AT指令带你接入腾讯物联网平台
11-18 972
文章目录一、前言一、前言    继ESP8266 AT固件接入腾讯物联网平台后，ESP32接入腾讯物联网平台的AT固件也出来了，大体上ESP8266和ESP32接入腾讯物联网平台的AT指令差别不大，主要区别就是配网方式。配网方式区别是ESP8266支持的配网方式有smartconfig和softAP，ESP32支持的配网方式有softAP和蓝牙配网。...
ESP32 AT指令设置可发现BLE设备名 && 与手机进行ble数据透传
11-07 2072
文章目录前言一、设置可发现BLE设备名1. 蓝牙广播包浅析2. 开始广播 && 发现BLE设备名称二、与手机进行ble数据透传1. 初始化蓝牙server模式2. 连接蓝牙3. 设置BLE透传参数5.开启透传前言    最近有不少朋友买了我们安信可的esp32系列模组反馈BLE无法显示设置的设备名称、无法与手机透传的问题，是不是模组或者固件有问题？    今天手把手教大家怎么设置可发现设备名及怎么与手机进
【安信可PB-01/02模组专题②】PB-01/02模组天猫精灵冷暖七彩灯应用
11-06 168
文章目录前言工具烧录固件连接配对步骤功能演示（AI语音&APP远程）结束前言写这篇文章的目的在于向大家介绍一下天猫精灵mesh灯的一些用法知识，继安信可的TB系列的蓝牙模组成功对接上天猫精灵以后，第二系列的PB-01,PB-02的蓝牙模组紧随其后也成功的对接了天猫精灵，实现了语音控制。我们今天不讲复杂的开发过程，我们只了解这个怎么使用，我用的是关于PPB-02/01开发板对接天猫语音控制灯的例子，接下来我将向大家演示操作步骤。工具所谓工欲善其事必先利其器，下边向大家列出我们准备的工具天
【博安通BW15模组专题②】博安通BW15模组快速入门指南，开发环境搭建
11-06 108
文章目录前言产品特性结构及资源开发环境搭建及烧录1 .编译代码2. 使用 JLink 在线调试3. 通过串口下载固件结束前言物联网产业的发展离不开芯片模组的支撑，低功耗WiFi的产品也在更新换代，所以我们保持着与时俱进的开拓精神。今天向大家推荐一款带BLE蓝牙和2.4GWiFi模块-BW15，这款模块使用的是瑞昱的原厂芯片，同样，封装成模组以后和ESP系列的几个热门模组是pin对pin的，可以在改动不大的情况下替换使用。接下来我就像大家介绍一下这款BW15的基本性能和使用方法。产品特性支持 80
【博安通BW15模组专题①】博安通BW15模组快速入门指南，连接TCP服务器
11-06 226
文章目录一. BW15概述二. 模组/开发板接线2.1 模组接线2.2 开发板接线三. 配网3.1 simple config 配网3.2 蓝牙配网3.3 指令配网四. 连接TCP服务器（以安信可透传云为例）五、其他一. BW15概述BW15 是一款高度集成的 Wi-Fi 和蓝牙 SOC 模块，主芯片 RTL8720CF 是一款支持 2.4GHz 无线 LAN（WLAN）和蓝牙低功耗（v4.2）的高集成低功耗芯片； 它在单个芯片中结合了 Real-M300 MCU，WLAN MAC，具有 1T1R 功
【安信可PB-01/02模组专题①】PB-01/02模组开发板应用- BLE-UART固件的使用教程
11-05 125
PB-01/02模组开发板应用- BLE-UART固件的使用教程1 固件的烧录2 指令集3 使用示例1 固件的烧录使用PlyPlusKit 工具擦除开发板已经烧录的固件，RST和PROG按键同时按下：出现UART RX : cmd>>:信息，则表示进入了烧录模式，点击Erase,擦除成功如图：点击Setting按键，选择config勾上勾点击OK设置完成后直接点击Write 进行烧录，烧录完成后如下图烧写完成后出现如下界面表示成功烧录2 指令集2.1 指令格式
【安信可首款阿里平头哥模组TG-12F】AT指令入门教程 && 接入阿里飞燕/天猫精灵平台
11-03 612
文章目录一. TG-12F概述二. 模组接线三、指令集四、接入阿里飞燕平台1.功能定义2.人机交互3. 添加测试设备4. 发布产品5.设置五元组进入配网6. 数据上报下发一. TG-12F概述     TG-12F模块采用平头哥TG7100C芯片，TG7100C 是智能新一代高集成 Wi-Fi 和 BLE 组合芯片。无线子系统包含 2.4G 射频、Wi-Fi 802.11b/g/n 和 BLE 基带/MAC 设计。微控制器子系统包含一个低功耗 32 位 RISC