代码分享-平面直角坐标系的机器手视觉引导计算中,通过两次固定相机定位拍照计算机器手目标坐标
设物体当前坐标为 (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
其中角度单位需一致(如弧度),必要时可将结果归一化到适当范围(如 [-π, π])。