共计 685 个字符,预计需要花费 2 分钟才能阅读完成。
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; }
正文完