[发明专利]一种多机器人同时与一个外部工装协同方法、介质及系统

说明书

本发明公开了一种多机器人同时与一个外部工装协同方法、介质及系统，该方法包括：主机器人在外部工装上建立用户坐标系，建立起主机器人与外部工装的联系；主机器人和从机器人均具有与世界坐标系的转化关系，基坐标系和用户坐标系分别与世界坐标系有联系，计算得到基坐标系与用户坐标系之间的变换关系。主机器人、从机器人和外部工装分别在用户坐标系下建立运动轨迹，主机器人根据运动轨迹规划计算出下一个插补周期外部工装的关节变化量，从而得到变化后的用户坐标系，从机器人根据变化后用户坐标系和世界坐标系计算得到从机器人末端下一个插补周期在世界坐标系下的点位信息。本发明使多台机器人可以同时与同一工装协同工作，增加了工作效率。

技术领域

本发明涉及焊接机器人技术领域，尤其涉及一种多机器人同时与一个外部工装协同方法、介质及系统。

背景技术

随着科技的发展，工业机器人的应用场景越来越多，越来越复杂。在一些应用中出现了多台机器人与同一外部轴协同的方案。如一个工件摆在外部工装，工件两端分别由两台机器人同时焊接。外部工装与机器人协同工作时，外部工装由机器人控制运动，在此应用中就产生了一个问题：两台机器人同时与一个外部工装协同工作，外部工装由哪一台机器人来控制。目前机器人焊接领域多为机器人单独施焊，一个外部工装与多台机器人协同鲜有报道，因此有必要设计一种多机器人同时与一个外部工装协同方法，以提高生产效率。

发明内容

本发明提供了一种多机器人同时与一个外部工装协同方法、介质及系统，以打破在一台控制器中，一台机器人只能与一台工装协同的限制，使多台机器人可以同时与同一工装协同工作，增加工作效率，降低工厂成本。

本发明采用的技术方案是：提供一种多机器人同时与一个外部工装协同方法，包括：

S1：同一控制器控制多台机器人和外部工装，机器人包括一个主机器人和至少一个从机器人；主机器人控制外部工装的轨迹动作，主机器人在外部工装上建立用户坐标系；建立用户坐标系和世界坐标系之间的联系；建立主机器人基坐标系与世界坐标系的联系；建立从机器人基坐标系与世界坐标系的联系；

S2：对主机器人、从机器人、外部工装分别在用户坐标系下建立运动轨迹；将其分解为若干个插补周期；主机器人和从机器人的运动轨迹中含有外部工装的轨迹点位信息；

S3：计算主机器人一个插补周期后其基坐标系下的末端位姿，反解得到关节值；发送关节值到伺服控制系统；

S4：根据一个插补周期后计算得到的新用户坐标系，再计算从机器人一个插补周期后其基坐标系下的末端位姿，反解得到关节值；发送关节值到伺服控制系统；

S5：重复S3和S4的插补过程，直至插补结束。

在一些实施例中，所述S1中，主机器人在外部工装上建立用户坐标系的方法包括：

在外部工装选定一标记点，转动外部工装的角度，记录一次主机器人末端在该标记点的点位信息；多次转动外部工装的角度，获得多个点位信息；进而计算出主机器人基坐标系下的用户坐标系。

在一些实施例中，所述S1中，建立用户坐标系和世界坐标系之间的联系的方法包括：

根据用户坐标系在主机器人基坐标系下的转化矩阵，计算用户坐标系和世界坐标系之间的转化矩阵，确定用户坐标系在世界坐标系下的位置。

在一些实施例中，所述S3包括：

S3.1：计算一个插补周期后世界坐标系中的用户坐标系；

S3.2：计算一个插补周期主机器人末端在用户坐标系中的位姿；

S3.3：根据S3.1和S3.2计算主机器人末端在世界坐标系的位姿；

S3.4：计算主机器人基坐标系与世界坐标系的矩阵转化关系，计算出主机器人在其基坐标系下的末端位姿；反解得到关节值。