火星坐标系 (GCJ-02) 与百度坐标系 (BD-09) 的转换算法

1. include <math.h>  
2.   
3. const double x_pi = 3.14159265358979324 * 3000.0 / 180.0;  
4.   
5. void bd_encrypt(double gg_lat, double gg_lon, double &bd_lat, double &bd_lon)  
6. {  
7.     double x = gg_lon, y = gg_lat;  
8.     double z = sqrt(x * x + y * y) + 0.00002 * sin(y * x_pi);  
9.     double theta = atan2(y, x) + 0.000003 * cos(x * x_pi);  
10.     bd_lon = z * cos(theta) + 0.0065;  
11.     bd_lat = z * sin(theta) + 0.006;  
12. }  
13.   
14. void bd_decrypt(double bd_lat, double bd_lon, double &gg_lat, double &gg_lon)  
15. {  
16.     double x = bd_lon - 0.0065, y = bd_lat - 0.006;  
17.     double z = sqrt(x * x + y * y) - 0.00002 * sin(y * x_pi);  
18.     double theta = atan2(y, x) - 0.000003 * cos(x * x_pi);  
19.     gg_lon = z * cos(theta);  
20.     gg_lat = z * sin(theta);  
21. }