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

Question

我有2个3D点，在此之间需要以弧度表示偏航角和俯仰角。

我已经尝试了许多公式，但实际上不起作用。

我的坐标系如下：

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之间的链接文章相同的计算。您将获得两点之间的距离，两点之间的偏航（航向）以及两点之间的俯仰。