原始GPS与百度、谷歌、高德地图的相互转换（c语言转换）

╰半夏微凉° 2023-03-04 09:18 13阅读 0赞

### 原始GPS与百度、谷歌、高德地图的相互转换（c语言转换） ###

*  原始GPS与百度、谷歌、高德地图的相互转换
 *   *  1.介绍三种坐标系
     *  2.WGS84、GCJ02、BD09之间的相互转换（C语言实现）

# 原始GPS与百度、谷歌、高德地图的相互转换 #

## 1.介绍三种坐标系 ##

在进行地图开发过程中，我们一般能接触到以下三种类型的地图坐标系：  
1.WGS-84：是国际标准，GPS坐标（Google Earth使用、或者GPS模块）；  
2.GCJ-02：中国坐标偏移标准，Google Map、高德、腾讯使用，又称为火星坐标；  
3.BD-09：百度坐标偏移标准，Baidu Map使用。  
![在这里插入图片描述][watermark_type_ZmFuZ3poZW5naGVpdGk_shadow_10_text_aHR0cHM6Ly9ibG9nLmNzZG4ubmV0L3FxXzQzNTM3NzIx_size_16_color_FFFFFF_t_70_pic_center]

## 2.WGS84、GCJ02、BD09之间的相互转换（C语言实现） ##

#include <stdio.h>
    #include <math.h>
    #include <stdlib.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);// 经度偏移量
    
    // 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) { 
        if (outOfChina(lat,lon))
        { 
            *pLat = lat;
            *pLon = lon;
            return 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;
       double 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) { 
        if (outOfChina(lat,lon))
        { 
            *pLat = lat;
            *pLon = lon;
            return 0;
        }
    	double *offset;
    	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) { 
        if (outOfChina(gcjlat,gcjlon))
        { 
            *wgs_Lat = gcjlat;
            *wgs_lon = gcjlon;
            return 0;
        }
    	double initDelta = 0.01;
    	double threshold = 0.000000001;
    	double dLat = initDelta, dLon = initDelta;
    	double mLat = gcjlat - dLat, mLon = gcjlon - dLon;
    	double pLat = gcjlat + dLat, pLon = gcjlon + dLon;
    	double wgsLat = 0.0, wgslon = 0.0, i = 0.0 ,newgcjlat = 0.0,newgcjlon = 0.0;
     
    	while (true) { 
    		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 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;
            double 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;
    }
    	
    //WGS84坐标 120.1067916,30.3430350
    //GCJ02坐标 120.111599,30.340772
    //BD09坐标 120.118000,30.347094
    
    int main()
    { 
     
    	double	lat=30.3430350;
    	double	lon=120.1067916;
    	double	newlat,newlon;
    	printf("WGS84: lat=%lf,lon=%lf 转\r\n",lat,lon);//WGS84坐标转GCJ02坐标 
    	if(wgs2gcj(lat,lon,&newlat,&newlon)==0)
    		printf("GCJ02: lat=%lf,lon=%lf\r\n",newlat,newlon);
    		
    	printf("-------------------------------------------\r\n"); 
    	
    //WGS84坐标转BD09坐标 
    	//printf("WGS84: lat=%lf,lon=%lf 转\r\n",lat,lon);//WGS84坐标转BD09坐标
    	//if(wgs2bd(lat,lon,&newlat,&newlon)==0)
    	// printf("BD09: //lat=%lf,lon=%lf\r\n",newlat,newlon);
    		
    	//printf("-------------------------------------------\r\n"); 
    
    //GCJ02转其他测试 
    	//double lat=30.340772;
    	//double lon=120.111599;
    	//double newlat,newlon;
    	//printf("GCJ02: lat=%lf,lon=%lf 转\r\n",lat,lon);//GCJ02坐标转BD09坐标 
    	//if(gcj2bd(lat,lon,&newlat,&newlon)==0)
    		//printf("BD09: lat=%lf,lon=%lf\r\n",newlat,newlon);
    			
    	//printf("-------------------------------------------\r\n"); 
    	
    	//printf("GCJ02: lat=%lf,lon=%lf 转(粗略)\r\n",lat,lon);//GCJ02坐标转WGS84坐标 ,粗略 
    	//if(gcj2wgs(lat,lon,&newlat,&newlon)==0)
    		//printf("WGS84: lat=%lf,lon=%lf\r\n",newlat,newlon);
    			
    	//printf("-------------------------------------------\r\n"); 
    	
    	//printf("GCJ02: lat=%lf,lon=%lf 转(精确)\r\n",lat,lon);//GCJ02坐标转WGS84坐标 ,精确 
    	//if(gcj2wgs_Exactly(lat,lon,&newlat,&newlon)==0)
    		//printf("WGS84: lat=%lf,lon=%lf\r\n",newlat,newlon);
    	
    	//printf("-------------------------------------------\r\n"); 
    
     
    //BD09转其他测试 
    	//double lat=30.347094;
    	//double lon=120.118000;
    	//double newlat,newlon;
    	//printf("BD09: lat=%lf,lon=%lf 转\r\n",lat,lon);//BD09坐标转GCJ02坐标 
    	//if(bd2gcj(lat,lon,&newlat,&newlon)==0)
    		//printf("GCJ02: lat=%lf,lon=%lf\r\n",newlat,newlon);
    				
    	//printf("-------------------------------------------\r\n"); 
    	
    	//printf("BD09: lat=%lf,lon=%lf 转(粗略)\r\n",lat,lon);//BD09坐标转WGS84坐标 ,粗略 
    	//if(bd2wgs(lat,lon,&newlat,&newlon)==0)
    		//printf("WGS84: lat=%lf,lon=%lf\r\n",newlat,newlon);
    				
    	//printf("-------------------------------------------\r\n"); 
    	
    	//printf("BD09: lat=%lf,lon=%lf 转(精确)\r\n",lat,lon);//BD09坐标转WGS84坐标 ,精确 
    	//if(bd2wgs_Exactly(lat,lon,&newlat,&newlon)==0)
    		//printf("WGS84: lat=%lf,lon=%lf\r\n",newlat,newlon);
    					
    	//printf("-------------------------------------------\r\n"); 
    
    		
     
    //GNGGA等格式转度格式 
        //double gpslng = 12006.4096;
        //double gpslat = 3020.5845;
        //double resultlng = 0;
       // double resultlat = 0;
        //resultlng = (int)(gpslng/100) + (gpslng/100.0 - (int)(gpslng/100)) *100.0 / 60.0;
       // resultlat = (int)(gpslat/100) + (gpslat/100.0 - (int)(gpslat/100)) *100.0 / 60.0;
        //printf("lng = %lf,lat = %lf\n",resultlng,resultlat); 
    }

[watermark_type_ZmFuZ3poZW5naGVpdGk_shadow_10_text_aHR0cHM6Ly9ibG9nLmNzZG4ubmV0L3FxXzQzNTM3NzIx_size_16_color_FFFFFF_t_70_pic_center]: /images/20230208/b52057f4359f42bab453ee7ea74ccbd6.png