坐标转换之WGS84坐标转换到火星坐标GCJ02

GNSS设备采集数据后，用到地图上需要转换，这里提供一下c版本的WGS84与GCJ02的转换代码。

double  x_pi = 3.14159265358979324 * 3000.0 / 180.0;
double pi = 3.1415926535897932384626;
double a = 6378245.0;
double ee = 0.00669342162296594323;




//********************************************
int out_of_china(double lng, double lat) {

	if (lng < 72.004 || lng > 137.8347)return 0;
    if (lat < 0.8293 || lat > 55.8271)return 0;
	return 1;
			
}
//********************************************
double transformlat(double lng, double lat) {

	double ret = 0;

	ret = -100.0 + 2.0 * lng + 3.0 * lat + 0.2 * lat * lat + 0.1 * lng * lat + 0.2 * sqrt(fabs(lng));
		
	ret += (20.0 * sin(6.0 * lng * pi) + 20.0 * sin(2.0 * lng * pi)) * 2.0 / 3.0;

	ret += (20.0 * sin(lat * pi) + 40.0 * sin(lat / 3.0 * pi)) * 2.0 / 3.0;

	ret += (160.0 * sin(lat / 12.0 * pi) + 320 * sin(lat * pi / 30.0)) * 2.0 / 3.0;
	return ret;
}
//********************************************
double transformlng(double lng, double lat) {

	double ret = 0;
	ret = 300.0 + lng + 2.0 * lat + 0.1 * lng * lng + 0.1 * lng * lat + 0.1 * sqrt(fabs(lng));

	ret += (20.0 * sin(6.0 * lng * pi) + 20.0 *sin(2.0 * lng * pi)) * 2.0 / 3.0;
		
	ret += (20.0 * sin(lng * pi) + 40.0 * sin(lng / 3.0 * pi)) * 2.0 / 3.0;
		
	ret += (150.0 * sin(lng / 12.0 * pi) + 300.0 * sin(lng / 30.0 * pi)) * 2.0 / 3.0;
	return ret;
}

//********************************************
void  wgs84togcj02(double lng, double lat,double* lnglat) {

	double  dlat = 0.0, dlng =0.0, radlat =0.0, magic =0.0,sqrtmagic = 0.0;

	// 中国区域 
	if (!out_of_china(lng, lat)) return;
	 dlat = transformlat(lng-105.0, lat- 35.0);
	 dlng = transformlng(lng-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);
	dlng = (dlng * 180.0) / (a / sqrtmagic * cos(radlat) * pi);
	  

	lnglat[0] = lng + dlng;
	lnglat[1] = lat + dlat;

}


//********************************************

void gcj02towgs84(double lng, double lat,double* lnglat) {

	double dlat = 0.0, dlng = 0.0, radlat = 0.0, magic = 0.0, sqrtmagic = 0.0, mglat = 0.0, mglng = 0.0;
	if (!out_of_china(lng, lat)) return;
	 dlat = transformlat(lng - 105.0, lat - 35.0);
	 dlng = transformlng(lng - 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);
	 dlng = (dlng * 180.0) / (a / sqrtmagic * cos(radlat) * pi);
   
	 mglat = lat + dlat;
	 mglng = lng + dlng;

	lnglat[0] = lng * 2 - mglng;
	lnglat[1] = lat * 2 - mglat;

}