坐标系
ABB多机器人作业,使用一套G代码,每个机器人的坐标系关系是如何的?假设有两台机器人A、B,工件坐标系为O.假设A、B、O在大地坐标系下的旋转矩阵分别为MA、MB、MO(大地坐标系旋转矩阵为单位阵E)。
机器人A要将工件坐标系下的坐标点α转化为局部坐标系下的坐标点β,MA的逆MA-1,那么β=MA-1*MO*α.其他机器人同理。
若已知B在A的坐标系下的旋转矩阵为MBA,如何根据MA求解MB?
(1)A坐标系下γ转换到B坐标系下为θ=MBA-1*γ.
(2)A坐标系下γ在世界坐标系下为MA*γ.
(3)B坐标系下θ在世界坐标系下为MB*θ.
根据(1)、(2)、(3):
MA*γ=MB*θ=MB*MBA-1*γ.
因任意坐标点γ都有(MA-MB*MBA-1)*γ=0成立。即:
MA=MB*MBA-1.
最终求解得到:
MB=MA*MBA