我试图做的是建立一个相对坐标系。它所做的是获取点 A 的 XYZ 坐标。然后它应该将该位置平移到点 B 上以获得点 C 的位置,点 B 可以在所有三个轴上旋转和平移,但点 A 仅平移,不平移旋转。
基本上发生的事情是你有2个矩形,一个左下角在原点,一个左下角是B点。如果第一个矩形的右上角是A点,那么在第二个矩形的右上角是 C 点,无论第二个矩形如何旋转或平移,C 点始终位于第二个矩形的右上角。但是,如果 A 点移动到右下角,那么 C 点将始终位于第二个矩形的右下角。
我曾多次尝试评估正确的表达方式,而我想出的结果我认为很接近。我有一些变化:
X': Xcos(pitch) - Zcos(pitch) + Xcos(yaw) + Ysin(yaw) + X.pointB
Y': Ycos(yaw) + Xsin(yaw) + Ycos(roll) + Zsin(roll) + Y.pointB
Z': Ysin(roll) + Zcos(roll) + Xsin(pitch) + Zcos(pitch) + Z.pointB
其中方程中的 XYZ 是点 A 的坐标,俯仰角、偏航角和滚动角是第二个矩形的角度(以度为单位)。