ABB多机器人坐标系之间的关系

来源:互联网 发布:淘宝企业店铺 企业资质 编辑:程序博客网 时间:2024/05/16 10:56

坐标系

ABB多机器人作业,使用一套G代码,每个机器人的坐标系关系是如何的?假设有两台机器人AB,工件坐标系为O.假设ABO在大地坐标系下的旋转矩阵分别为MAMBMO(大地坐标系旋转矩阵为单位阵E)。

机器人A要将工件坐标系下的坐标点α转化为局部坐标系下的坐标点β,MA的逆MA-1,那么β=MA-1*MO*α.其他机器人同理。

若已知BA的坐标系下的旋转矩阵为MBA,如何根据MA求解MB

1A坐标系下γ转换到B坐标系下为θ=MBA-1*γ.

2A坐标系下γ在世界坐标系下为MA*γ.

3B坐标系下θ在世界坐标系下为MB*θ.

根据(1)、(2)、(3):

MA*γ=MB*θ=MB*MBA-1*γ.

因任意坐标点γ都有(MA-MB*MBA-1)*γ=0成立。即:

MA=MB*MBA-1.

最终求解得到:

MB=MA*MBA

 

原创粉丝点击