双天线模式下的航向角计算

如果你有主天线和从天线的经纬度坐标，并想计算航向角，通常你需要计算主天线到从天线的方向。这可以通过以下步骤实现：

• 计算主天线和从天线的经纬度差值，即从天线相对于主天线的位置。

• 使用差值经纬度计算方向角。

以下是用C++实现的示例代码：

#include <iostream>
#include <cmath>

struct GPSCoordinate {
    double latitude;  // 纬度，单位：度
    double longitude; // 经度，单位：度
};

// 计算两个GPS坐标点之间的方向角（航向角）
double calculateHeadingAngle(const GPSCoordinate& mainAntenna, const GPSCoordinate& secondaryAntenna) {
    // 将经纬度从度数转换为弧度
    double lat1 = mainAntenna.latitude * M_PI / 180.0;
    double lon1 = mainAntenna.longitude * M_PI / 180.0;
    double lat2 = secondaryAntenna.latitude * M_PI / 180.0;
    double lon2 = secondaryAntenna.longitude * M_PI / 180.0;

    // 计算差值
    double deltaLon = lon2 - lon1;

    // 计算方向角（航向角） using arctan2
    double y = sin(deltaLon) * cos(lat2);
    double x = cos(lat1) * sin(lat2) - sin(lat1) * cos(lat2) * cos(deltaLon);
    double angle = atan2(y, x);

    // 将弧度转换为度数
    angle = angle * 180.0 / M_PI;

    // 确保航向角在0到360度之间
    if (angle < 0) {
        angle += 360.0;
    }

    return angle;
}

int main() {
    GPSCoordinate mainAntenna = {40.7128, -74.0060}; // 主天线的GPS坐标
    GPSCoordinate secondaryAntenna = {34.0522, -118.2437}; // 从天线的GPS坐标

    double headingAngle = calculateHeadingAngle(mainAntenna, secondaryAntenna);
    std::cout << "航向角：" << headingAngle << " 度" << std::endl;

    return 0;
}