已知两点经纬度求航向

最新推荐文章于 2023-08-22 08:47:55 发布

geerniya

最新推荐文章于 2023-08-22 08:47:55 发布

阅读量5k

点赞数 1

分类专栏： C++ 文章标签：航向角

本文链接：https://blog.csdn.net/geerniya/article/details/109175330

版权

C++ 专栏收录该内容

14 篇文章 0 订阅

订阅专栏

struct PointLB{
    double lat;
    double lon;
};

double getAzimuth(PointLB pA, PointLB pB)
{
    double a = (90 - pB.lat) * PI / 180;
    double b = (90 - pA.lat) * PI / 180;
    double AOC_BOC = (pB.lon - pA.lon) * PI / 180;
    double cosc = cos(a) * cos(b) + sin(a) * sin(b) * cos(AOC_BOC);
    double sinc = sqrt(1 - cosc * cosc);
    double sinA = sin(a) * sin(AOC_BOC) / sinc;
    double A = asin(sinA) * 180 / PI;
    double res = 0;
    if (pB.lon > pA.lon && pB.lat > pA.lat) res = A;
    else if (pB.lon > pA.lon && pB.lat < pA.lat) res = 180 - A;
    else if (pB.lon < pA.lon && pB.lat < pA.lat) res = 180 - A;
    else if (pB.lon < pA.lon && pB.lat > pA.lat) res = 360 + A;
    else if (pB.lon > pA.lon && pB.lat == pA.lat) res = 90;
    else if (pB.lon < pA.lon && pB.lat == pA.lat) res = 270;
    else if (pB.lon == pA.lon && pB.lat > pA.lat) res = 0;
    else if (pB.lon == pA.lon && pB.lat < pA.lat) res = 180;

    return res;
}