💥 注意事项
原始GPS的经纬度(NMEA)需要转换为GPS坐标(WGS)进行计算
static double gpstowgs(double d) {
return floor(d / 100) + fmod(d, 100) / 60;
}
🔑 计算方法
#include <math.h>
#define EARTH_RADIUS 6371393//地球半径 根据百度百科得到的数据
#define PI 3.14159265358979323846 //圆周率
//角度转化为弧度
static double rad(double d)
{
return d * PI / 180.0;
}
double GetDistance(double lon1, double lat1, double lon2, double lat2) {
double radLat1 = rad(lat1);
double radLat2 = rad(lat2);
double a = radLat1 - radLat2;
double b = rad(lon1) - rad(lon2);
double s = 2 * asin(sqrt(pow(sin(a / 2), 2) + cos(radLat1) * cos(radLat2) * pow(sin(b / 2), 2)));
s = s * EARTH_RADIUS;
return s;
}