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