计算两个经纬度之间的实际距离(Haversine公式)----c++

来源:https://www.open-open.com/lib/view/open1430573897802.html

原理亦可参考:https://blog.csdn.net/gaocuisheng/article/details/126060795

cpp 复制代码
#include <cmath>
#define EARTH_RADIUS  6371.0;// 地球半径,单位千米

static double HaverSin(double theta)
{
    double v = sin(theta / 2);
    return v * v;
}

static double ConvertDegreesToRadians(double degrees)
{
    return degrees * M_PI / 180;
}

	/// <summary>
	/// 计算2个经纬度之间的距离
	/// </summary>
	/// <param name="from_lon">起始点经度</param>
	/// <param name="from_lat">起始点纬度</param>
	/// <param name="to_lon">目标点经度</param>
	/// <param name="to_lat">目标点纬度</param>
	/// <returns></returns>
static double TwoPointToDistance(double from_lon, double from_lat, double to_lon, double to_lat)
{
    // 用 haversine 公式计算球面两点间的距离。
    // 经纬度转换成弧度
    from_lon = ConvertDegreesToRadians(from_lon);
    from_lat = ConvertDegreesToRadians(from_lat);
    to_lon = ConvertDegreesToRadians(to_lon);
    to_lat = ConvertDegreesToRadians(to_lat);
    // 差值
    double vLon = std::abs(from_lon - to_lon);
    double vLat = std::abs(from_lat - to_lat);
    // h is the great circle distance in radians, great circle 就是一个球体上的切面,它的圆心即是球心的一个周长最大的圆。
    double h = HaverSin(vLat) + cos(from_lat) * cos(to_lat) * HaverSin(vLon);
    auto sh = sqrt(h);
    double distance = 2 * (asin(sqrt(h))) * EARTH_RADIUS;

    // 将距离转换为米
    distance *= 1000;

    return distance;
}

int main() {
    // 39.94607,116.32793  31.24063,121.42575
    std::cout << TwoPointToDistance(39.94607, 116.32793, 31.24063, 121.42575) << " meters" << std::endl;

    return 0;
}
相关推荐
算法歌者1 分钟前
[算法]入门1.矩阵转置
算法
林开落L16 分钟前
前缀和算法习题篇(上)
c++·算法·leetcode
远望清一色17 分钟前
基于MATLAB边缘检测博文
开发语言·算法·matlab
tyler_download19 分钟前
手撸 chatgpt 大模型:简述 LLM 的架构,算法和训练流程
算法·chatgpt
何曾参静谧25 分钟前
「Py」Python基础篇 之 Python都可以做哪些自动化?
开发语言·python·自动化
Prejudices29 分钟前
C++如何调用Python脚本
开发语言·c++·python
单音GG32 分钟前
推荐一个基于协程的C++(lua)游戏服务器
服务器·c++·游戏·lua
SoraLuna39 分钟前
「Mac玩转仓颉内测版7」入门篇7 - Cangjie控制结构(下)
算法·macos·动态规划·cangjie
我狠狠地刷刷刷刷刷42 分钟前
中文分词模拟器
开发语言·python·算法
鸽鸽程序猿42 分钟前
【算法】【优选算法】前缀和(上)
java·算法·前缀和