根据两个位置的经纬度，计算其距离和方位

奕星星奕

于 2024-08-29 22:59:10 发布

阅读量88

点赞数 1

文章标签： c++ 算法开发语言

本文链接：https://blog.csdn.net/qq_32285693/article/details/141690466

版权

#include <iostream>
#include <cmath>

const double EARTH_RADIUS = 6371000.0; // 地球半径 (单位：米)
const double DEG_TO_RAD = M_PI / 180.0;

// 计算两个经纬度之间的距离 (单位：米) 和方位 (单位：度)
void calculate_distance_and_bearing(double lat1, double lon1, double lat2, double lon2, double &distance, double &bearing) {
    // 计算距离
    double dLat = (lat2 - lat1) * DEG_TO_RAD;
    double dLon = (lon2 - lon1) * DEG_TO_RAD;

    double a = std::sin(dLat / 2) * std::sin(dLat / 2) +
               std::cos(lat1 * DEG_TO_RAD) * std::cos(lat2 * DEG_TO_RAD) *
               std::sin(dLon / 2) * std::sin(dLon / 2);
    double c = 2 * std::atan2(std::sqrt(a), std::sqrt(1 - a));
    distance = EARTH_RADIUS * c;

    // 计算方位
    double y = std::sin(dLon) * std::cos(lat2 * DEG_TO_RAD);
    double x = std::cos(lat1 * DEG_TO_RAD) * std::sin(lat2 * DEG_TO_RAD) -
               std::sin(lat1 * DEG_TO_RAD) * std::cos(lat2 * DEG_TO_RAD) * std::cos(dLon);
    
    bearing = std::atan2(y, x) * 180.0 / M_PI; // 转换为度
    bearing = fmod(bearing + 360.0, 360.0); // 确保结果在 0 到 360 度之间
}

int main() {
    double lat1 = 34.05; // 点 A 的纬度
    double lon1 = -118.25; // 点 A 的经度
    double lat2 = 40.71; // 点 B 的纬度
    double lon2 = -74.01; // 点 B 的经度

    double distance, bearing;
    calculate_distance_and_bearing(lat1, lon1, lat2, lon2, distance, bearing);

    std::cout << "Distance: " << distance << " meters" << std::endl;
    std::cout << "Initial Bearing: " << bearing << " degrees" << std::endl;

    return 0;
}

1. 常量定义：
- EARTH_RADIUS：地球半径，单位为米。

2. calculate_distance_and_bearing`函数：
- 输入：两个点的纬度和经度。
- 输出：距离（米）和方位（度）。

3. main函数：
- 提供经纬度，调用计算函数，并输出结果。