c++ - 计算二维 vector 的偏航

Question

我有两个 3D 点(但是 z 坐标始终为零)并且想要计算从这些点创建的方向 vector 的偏航。 我已经找到了 this发布，并基于它尝试了以下代码:

double p1_x, p1_y, p2_x, p2_y;
//initialize vars...

double dx = p2_x - p1_x;
double dy = p2_y - p1_y;

double yaw = atan(dx/-dy);

但是，如果我测试这种方法，我似乎会得到奇怪的结果。此外，这种方法似乎不考虑 dy 为零的情况。 我的问题是我并不完全了解底层数学，所以我在调整代码时遇到了麻烦。

我的问题是:需要如何调整此方法才能返回适当的偏航？为什么它不能在当前状态下工作？

感谢您的帮助和问候， 脚本

Answer 1

通常，人们会使用 atan2(已记录 here 和 here )

double dx = p2_x - p1_x;
double dy = p2_y - p1_y;

double yaw = atan2(dy, dx);

这个版本的代码应该能满足您的需求。

如果您想要以度为单位的值，则可以乘以 180/PI。