设物体当前坐标为 (X1, Y1, R1),模组当前坐标为 (X2, Y2, R2),物体目标坐标为 (X3, Y3, R3)。计算旋转差 ΔR = R3 - R1,则模组的新坐标 (X4, Y4, R4) 为:

X4 = X3 + cos(ΔR) (X2 - X1) - sin(ΔR) (Y2 - Y1)
Y4 = Y3 + sin(ΔR) (X2 - X1) + cos(ΔR) (Y2 - Y1)
R4 = R2 + ΔR

其中角度单位需一致(如弧度),必要时可将结果归一化到适当范围(如 [-π, π])。

标签: none

添加新评论