#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函数:
- 提供经纬度,调用计算函数,并输出结果。