两个3D点之间的偏航和俯仰

Question

我有2个3D点，我需要在弧度之间得到Yaw和Pitch。

我尝试了很多公式，但它没有尝试过。工作

我的坐标系统如下：

X= left right
Y = forward backward
Z = up down

有任何帮助吗？请具体说明。我真的很感激整个公式。

Answer 1

您可以使用我发布的here公式来计算偏航（“航向”）和到点之间的间距。唯一的区别是我的计算只包含一个点（另一个点是原点(0,0,0）。不过，您仍然可以使用相同的计算，只需从pointA中减去pointB，然后将其输入到函数中即可。

例如，如果您的两点是：

pointA = (20,3,8)
pointB = (34,2,0)

首先从pointB减去pointA：

pointB - pointA = (34,2,0) - (20,3,8)
                = (14,-1,-8)

然后将此新点命名为pointC。现在，使用与原点和pointC之间的链接文章相同的计算。您将获得两点之间的距离，两点之间的偏航（航向）以及两点之间的俯仰。