blob: cf7267845cc5f1ef7fcba895ccaaec01b2f70505 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
|
#include "distance_on_sphere.hpp"
#include "../base/math.hpp"
#include "../std/algorithm.hpp"
double ms::DistanceOnSphere(double lat1Deg, double lon1Deg, double lat2Deg, double lon2Deg)
{
double const lat1 = my::DegToRad(lat1Deg);
double const lat2 = my::DegToRad(lat2Deg);
double const dlat = sin((lat2 - lat1) * 0.5);
double const dlon = sin((my::DegToRad(lon2Deg) - my::DegToRad(lon1Deg)) * 0.5);
double const y = dlat * dlat + dlon * dlon * cos(lat1) * cos(lat2);
return 2.0 * atan2(sqrt(y), sqrt(max(0.0, 1.0 - y)));
}
|