GPS真实坐标与火星地图坐标/百度地图坐标的转换

vany5921

      使用GPS模块可以获得真实地理坐标，但是，往往我们将得到的数据放到一些地图服务商提供的地图上查看会发现偏移很大。其实，很多人忽略了一点，国家为了电子地图安全，强制要求地图服务商对地图坐标进行加密，产生随机偏移，因此我们看到的地图上标注的地理位置并不是自己的真实地理位置。GCJ-02加密标准是基本的数据加密算法，百度地图在GCJ-02的基础上又加入了自己的一套加密算法。以下将获得的GPS数据转换为GCJ-02地理坐标或百度地图坐标，通过逆向地理编码你就能查到具体的位置信息。

1. #include <M5Stack.h>
   
2. #include <TinyGPS++.h>
   
3. #include <math.h>
   
4. static const uint32_t GPSBaud = 9600;
   
5. TinyGPSPlus gps;
   
6. HardwareSerial ss(2);
   
7. 
   
8. double pi = 3.14159265358979324;      //圆周率
   
9. double ee = 0.00669342162296594323;   //椭球的偏心率
   
10. double a = 6378245.0;                 //卫星椭球坐标投影到平面地图坐标系的投影因子
    
11. double x_pi = 3.14159265358979324 * 3000.0 / 180.0;  //圆周率转换量
    
12. double Lat;
    
13. double Lon;
    
14. 
    
15. // 求弧度
    
16. double radian(double d)
    
17. {
    
18.     return d * pi / 180.0;   //角度1? = π / 180
    
19. }
    
20. 
    
21. double transformLat(double lat, double lon)    //纬度转化
    
22. {
    
23.    double ret = -100.0 + 2.0 * lat + 3.0 * lon + 0.2 * lon * lon + 0.1 * lat * lon + 0.2 * sqrt(abs(lat));
    
24.    ret += (20.0 * sin(6.0 * lat * pi) + 20.0 * sin(2.0 * lat * pi)) * 2.0 / 3.0;
    
25.    ret += (20.0 * sin(lon * pi) + 40.0 * sin(lon / 3.0 * pi)) * 2.0 / 3.0;
    
26.    ret += (160.0 * sin(lon / 12.0 * pi) + 320 * sin(lon * pi  / 30.0)) * 2.0 / 3.0;
    
27.    return ret;
    
28. }
    
29. 
    
30. 
    
31. double transformLon(double lat,double lon)   //经度转化
    
32. {
    
33.    double ret = 300.0 + lat + 2.0 * lon + 0.1 * lat * lat + 0.1 * lat * lon + 0.1 * sqrt(abs(lat));
    
34.    ret += (20.0 * sin(6.0 * lat * pi) + 20.0 * sin(2.0 * lat * pi)) * 2.0 / 3.0;
    
35.    ret += (20.0 * sin(lat * pi) + 40.0 * sin(lat / 3.0 * pi)) * 2.0 / 3.0;
    
36.    ret += (150.0 * sin(lat / 12.0 * pi) + 300.0 * sin(lat / 30.0 * pi)) * 2.0 / 3.0;
    
37.    return ret;
    
38. }
    
39. 
    
40. 
    
41. /*****************************************************************************
    
42. * WGS84(GPS坐标系) to 火星坐标系(GCJ-02)
    
43. *
    
44. * @param lat
    
45. * @param lon
    
46. * @return
    
47. ****************************************************************************/
    
48. void GPS84_To_GCJ02(double WGS84_Lat, double WGS84_Lon,double * GCJ02_Lat, double * GCJ02_Lon)
    
49. {
    
50.   double dLat;
    
51.   double dLon;
    
52.   double radLat;
    
53.   double magic;
    
54.   double sqrtMagic;
    
55. 
    
56.   dLat = transformLat(WGS84_Lon - 105.0, WGS84_Lat - 35.0);
    
57.   dLon = transformLon(WGS84_Lon - 105.0, WGS84_Lat - 35.0);
    
58.   radLat = WGS84_Lat / 180.0 * pi;
    
59.   magic = sin(radLat);
    
60.   magic = 1 - ee * magic * magic;
    
61.   sqrtMagic = sqrt(magic);
    
62.   dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * pi);
    
63.   dLon = (dLon * 180.0) / (a / sqrtMagic * cos(radLat) * pi);
    
64.   *GCJ02_Lat = WGS84_Lat + dLat;    //GCJ02_Lat是百度纬度存储变量的地址  *GCJ02_Lat就是那个值
    
65.   *GCJ02_Lon = WGS84_Lon + dLon;    //GCJ02_Lon是百度经度存储变量的地址  *GCJ02_Lon
    
66. }
    
67. 
    
68. 
    
69. 
    
70. /*****************************************
    
71. * 火星坐标系 (GCJ-02) 与百度坐标系 (BD-09) 的转换算法 将 GCJ-02 坐标转换成 BD-09 坐标
    
72. *
    
73. * @param gg_lat
    
74. * @param gg_lon
    
75. *****************************************/
    
76. //传入的参数    GCJ02_To_BD09(*BD09_Lat,*BD09_Lon,BD09_Lat,BD09_Lon);
    
77. //(*BD09_Lat,*BD09_Lon)火星坐标,(BD09_Lat,BD09_Lon)是变量的地址
    
78. void GCJ02_To_BD09(double GCJ02_Lat,double GCJ02_Lon,double * BD_09_Lat,double * BD_09_Lon)
    
79. {
    
80.     double x = GCJ02_Lon, y = GCJ02_Lat;
    
81.     double z= sqrt(x * x + y * y) + 0.00002 * sin(y * x_pi);
    
82.     double theta =atan2(y, x) + 0.000003 * cos(x * x_pi);
    
83.     *BD_09_Lon = z * cos(theta) + 0.0065;
    
84.     *BD_09_Lat = z * sin(theta) + 0.006;
    
85. }
    
86. 
    
87. 
    
88. /*************************************************************
    
89. 函数名称：GPS_transformation(double WGS84_Lat, double WGS84_Lon,double * BD_09_Lat, double * BD_09_Lon)
    
90. 函数功能：GPS坐标转百度地图坐标
    
91. 输入参数：WGS84_Lat,WGS84_Lon GPS获取到真实经纬度  储存得到的百度经纬度变量的地址 BD_09_Lat,BD_09_Lon指向那个变量
    
92. 输出参数：
    
93. *************************************************************/
    
94. void GPS_transformation(double WGS84_Lat,double WGS84_Lon,double * BD_09_Lat,double * BD_09_Lon)
    
95. {
    
96.    GPS84_To_GCJ02(WGS84_Lat,WGS84_Lon,BD_09_Lat,BD_09_Lon);           //GPS坐标转火星坐标
    
97.    GCJ02_To_BD09(*BD_09_Lat,*BD_09_Lon,BD_09_Lat,BD_09_Lon);           //火星坐标转百度坐标
    
98. }
    
99. 
    
100. 
     
101. 
     
102. /*************************************************************
     
103. 函数名称：double GetDistance(double lat1, double lng1, double lat2, double lng2)
     
104. 函数功能：返回两个点之间的距离
     
105. 输入参数：两个点的经纬度(角度)
     
106. 输出参数：距离(单位：km)
     
107. *************************************************************/
     
108. double Cal_Distance(double lat1, double lng1, double lat2, double lng2)
     
109. {
     
110.     double EARTH_RADIUS = 6378.137;        //地球近似半径
     
111.     double radLat1 = radian(lat1);
     
112.     double radLat2 = radian(lat2);
     
113.     double a = radLat1 - radLat2;
     
114.     double b = radian(lng1) - radian(lng2);
     
115.      
     
116.     double dst = 2 * asin((sqrt(pow(sin(a / 2), 2) + cos(radLat1) * cos(radLat2) * pow(sin(b / 2), 2) )));    //asin()反正弦值函数
     
117.      
     
118.     dst = dst * EARTH_RADIUS;
     
119.     dst= (uint32_t)(dst * 10000.0) / 10000.0;//舍弃小数点后4位的数
     
120.     return dst;
     
121. }
     
122. 
     
123. static void smartDelay(unsigned long ms)
     
124. {
     
125.   unsigned long start = millis();
     
126.   do
     
127.   {
     
128.     while (ss.available())
     
129.       gps.encode(ss.read());
     
130.   } while (millis() - start < ms);
     
131. }
     
132. 
     
133. 
     
134. void setup() {
     
135.   M5.begin();
     
136.   ss.begin(GPSBaud);
     
137. 
     
138. }
     
139. 
     
140. void loop() {
     
141.   M5.Lcd.setCursor(0, 0, 2);
     
142.   M5.Lcd.printf("%16.12f\n", gps.location.lat());
     
143.   M5.Lcd.printf("%16.12f\n", gps.location.lng());
     
144.   GPS_transformation(gps.location.lat(),gps.location.lng(), &Lat, &Lon);
     
145.   M5.Lcd.printf("%16.12f\n",Lat);
     
146.   M5.Lcd.printf("%16.12f\n",Lon);
     
147.   smartDelay(2000);
     
148.   //M5.Lcd.clear();
     
149. 
     
150. }

复制代码

如何测试计算的准不准呢，我是在百度开发者控制中心找到位置服务的接口测试进行逆向地理编码来查看解析的位置是否正确，这样可以保证我在百度系内调用任何地理数据都准确无误。

千斤顶

厉害，高手呀！