方位角是从正北顺时针到目标方向的角度,范围0–360°,正确公式为atan2(dx, dy)(dx为东向增量,dy为北向增量),结果负值需加2π归一化;地理坐标须用球面公式如haversine,不可直接套用平面公式。

方位角定义和数学公式要先搞清
方位角不是简单用 atan2 算完就完事——它特指从正北方向顺时针旋转到目标方向的角度,范围是 0 到 360 度(或 0 到 2*PI 弧度)。很多人直接套用 atan2(dy, dx) 得到的是从正东逆时针的角度,结果完全不对。
正确做法是:把坐标系“转过来”,让 y 轴当北、x 轴当东,然后用 atan2(dx, dy)(注意参数顺序颠倒),再做模运算归一化。
-
dx = x2 - x1(东向增量) -
dy = y2 - y1(北向增量) - 方位角(弧度)=
atan2(dx, dy) - 若结果为负,加
2 * M_PI使其落在[0, 2*PI)
C++ 实现要小心 atan2 参数顺序和单位
标准库 atan2(y, x) 是先 y 后 x,但方位角需要的是“东偏北”的关系,所以必须传 dx 作第一个参数、dy 作第二个参数。传反了会得到镜像错误值,比如本该是 45 度变成 315 度。
另外,默认返回弧度,如果项目用角度制,得手动乘 180.0 / M_PI;别忘了 #define _USE_MATH_DEFINES 或 #include <cmath> 并确保 M_PI 可用(某些平台不默认定义)。
立即学习“C++免费学习笔记(深入)”;
#include <cmath>
#define _USE_MATH_DEFINES // Windows 下必需
double bearing(double x1, double y1, double x2, double y2) {
double dx = x2 - x1;
double dy = y2 - y1;
double rad = atan2(dx, dy); // 注意:dx 在前,dy 在后
if (rad < 0) rad += 2 * M_PI;
return rad; // 返回弧度;如需角度,return rad * 180.0 / M_PI;
}
地理坐标(经纬度)不能直接套用这个公式
上面的代码只适用于平面直角坐标系(比如 UTM 投影后的米制坐标)。如果输入是 lat/lon,两点间距离大时球面曲率影响显著,atan2 算出的只是近似方位角,误差可能达几度甚至更多。
组合式C++代码评审方案,融合静态分析、AI推理、多轮迭代评审和C++专项检查,适用于PR审查、增量代码审查、全项目评审和代码质量评分,触发词包括review cpp、cpp代码评审、C++review、代码审查。
真实场景中,GPS 或地图 API 返回的经纬度应走球面三角公式,例如 Vincenty 或更轻量的 haversine 方位角推导:
- 用
sin/cos/tan和弧度转换处理lat1,lon1,lat2,lon2 - 核心是计算
atan2(sin(Δlon) * cos(lat2), cos(lat1)*sin(lat2) − sin(lat1)*cos(lat2)*cos(Δlon)) - 结果仍需归一化到
[0, 2*PI)
别图省事直接喂经纬度进平面公式——尤其跨纬度 > 0.5° 时,偏差肉眼可见。
浮点精度和零向量必须检查
当 dx 和 dy 都接近 0(即两点几乎重合),atan2(0, 0) 返回 0,但实际方位角无定义。不加判断会导致后续逻辑误判方向。
建议在调用前加短路检查:
if (fabs(dx) < 1e-9 && fabs(dy) < 1e-9) {
throw std::invalid_argument("Points are identical: bearing undefined");
}
另外,atan2 对极小值稳定,但用 float 而非 double 时,在高精度需求下(比如航迹推算)可能累积误差,优先用 double。
真正麻烦的从来不是公式本身,而是坐标系假设是否成立、单位是否统一、退化情况有没有兜底——这些地方漏掉一个,结果就跑偏了。

















