526互联

计算点的方位角 （osg）

发布时间 2023-06-22 16:52:52作者: 红湿处

原文链接

double getAngleByLatLon(double ax, double ay, double bx, double by)
{
ax = ax * osg::PI / 180;
ay = ay * osg::PI / 180;
bx = bx * osg::PI / 180;
by = by * osg::PI / 180;

double temValue = 0;

// 经纬度相同或则纬度相同
if(ax == bx || ay == by)
{
// 经度形同
if(ax == bx)
{
if(by >= ay)
{
return 0;
}
else
{
return 180;
}
}
// 纬度相同
else
{
if(bx >= ax)
{
return 90;
}
else
{
return 270;
}
}
}

tmpValue = sin(ay) * sin(by) + cos(ay) * cos(by) * cos(bx - ax);
tmpValue = sqrt(1 - tmpValue * tmpValue);
tmpValue = cos(by) * sin(bx - ax) / tmpValue;
double angle = abs(asin(tmpValue) * 180 / osg::PI);

if(bx > ax)
{
if(by > ay)
{
// 第一象限
return angle;
}
else
{
// 第二象限
return 180 - angle;
}
}
else
{
if(by >= ay)
{
// 第四象限
return 360 - angle;
}
else
{
// 第三象限
return 180 + angle;
}
}
}