计算两个未知点之间的俯仰和偏航

Question

我一直在处理3D空间（X、Y、Z）中的点，希望能够计算其中两个点之间的俯仰和偏航。

我的当前代码：

pitch = (float) (1/Math.tan((Y1 - Y2) / (Z1 - Z2)));
yaw = (float) (1/Math.tan((X1 - X2) / (Z1 - Z2)));

其中X1、X2、Y1、Y2、Z1、Z2在运行时之前都是未知的，此时它们是从两个随机生成的点收集的。

然而，由于某种原因，我的结果大错特错，我尝试了许多不同的组合，在google上搜索了无数的东西，但什么都没有找到。

一些制约因素是：

1. 节距只能小于或等于90，或大于或等于-90（90=

这是我第一次使用3D角度，我读过俯仰和偏航可以分别计算，就像我的例子一样，在两个不同的2D平面上，但这不起作用。

任何帮助非常感谢。

Answer 1

也许这对你有帮助。这是LucasEmanuel的一个教程，这是一个用于Minecraft的俯仰、偏航计算，但它也应该适用于您的！

首先你必须计算delta x， y， z：

double dX = first_location.getX() - second_location.getX();
double dY = first_location.getY() - second_location.getY();
double dZ = first_location.getZ() - second_location.getZ();

之后，必须计算偏航：

double yaw = Math.atan2(dZ, dX);

以及它的音高：

double pitch = Math.atan2(Math.sqrt(dZ * dZ + dX * dX), dY) + Math.PI;

如果需要向量，请按以下方式操作：

double X = Math.sin(pitch) * Math.cos(yaw);
double Y = Math.sin(pitch) * Math.sin(yaw);
double Z = Math.cos(pitch);

Vector vector = new Vector(X, Z, Y);

原始教程

基本上，计算应该是相同的。如果对你没有帮助，我很抱歉！