#include <iostream>
#include <cmath>
using namespace std;
double EARTH_RADIUS = 6378.137;//地球半径
double PI=3.1415926535;
double rad(double d){
return d * PI / 180.0;
}
double round(double d){
return floor(d + 0.5);
}
double get_distance(double lat1, double lng1, double lat2, double lng2)
{
double radLat1 = rad(lat1);
double radLat2 = rad(lat2);
double a = radLat1 - radLat2;
double b = rad(lng1) - rad(lng2);
double s = 2 * asin(sqrt(pow(sin(a/2),2) +cos(radLat1)*cos(radLat2)*pow(sin(b/2),2)));
s = s * EARTH_RADIUS;
s = round(s * 10000) / 10000;
return s;
}
int main(int argc, char** argv) {
double d = get_distance(40.0706,116.588717,40.070917,116.588684);
cout<<d*1000<<"m"<<endl;
}
以上代码已经过测试。