一种多机器人协同的动态干涉区划定方法与流程

摘要: 本发明涉及工业机器人协同控制,具体涉及一种多机器人协同的动态干涉区划定方法。背景技术:1、在工业自动化生产中,为提升作业效率,多机器人协同作业已成为主流应用方案...
一种多机器人协同的动态干涉区划定方法与流程

本发明涉及工业机器人协同控制,具体涉及一种多机器人协同的动态干涉区划定方法。

背景技术:

1、在工业自动化生产中,为提升作业效率,多机器人协同作业已成为主流应用方案,尤其在钢板切割后零件分拣场景中,通常采用多台搭载直线地轨的工业机器人,协同完成大范围钢板零件的抓取、分拣与码放作业。为避免机器人之间发生碰撞干涉,需对作业空间内的干涉区进行划定,确保同一时间仅单台机器人在干涉区内作业。

2、现有技术中,针对固定基座的工业机器人,通常采用固定干涉区划定方案,即预先划定机器人作业重叠的固定空间区域作为干涉禁区,通过互锁逻辑控制机器人进入权限。但对于搭载地轨等附加轴的可移动基座机器人,该方案存在局限性:

3、1、空间利用率极低,作业效率受限。固定干涉区需按照机器人最大运动范围划定,大量无干涉风险的安全空间被划入禁区,机器人无法在非干涉区间并行作业,造成空间与时间的双重浪费,无法发挥多机协同的效率优势。

4、2、适配灵活性差,无法适配动态作业工况。针对分拣场景中钢板零件位置随机、机器人目标点位动态变化的工况,固定干涉区无法随机器人的实时位置与作业目标动态调整,只能采用最大安全冗余的划定方式,进一步压缩了机器人的有效作业空间。

5、3、安全校验维度单一,存在干涉风险。现有方案大多仅针对机器人基座位置进行简单距离判断,未同时兼顾机械臂与末端工具端的空间干涉,易出现基座无干涉但工具端、臂身发生碰撞的情况;且多数方案仅检测机器人实时位置,未在动作前对目标点位进行预校验,易导致机器人动作过程中突发急停甚至碰撞,设备稳定性与作业安全性不足。

6、针对上述现有技术的缺陷,本发明提出一种多机器人协同的动态干涉区划定方法,以解决固定干涉区灵活性差、空间利用率低、安全校验不全面、作业效率不足的问题。

技术实现思路

1、本发明提出的一种多机器人协同的动态干涉区划定方法,可至少解决背景技术中的技术问题之一。

2、为实现上述目的,本发明采用了以下技术方案:

3、一种多机器人协同的动态干涉区划定方法,应用于包含至少两台工业机器人的协同作业系统,所述协同作业系统包括上位机、可编程逻辑控制器plc,所述plc分别与所述上位机、各台工业机器人通信连接;所述方法包括以下步骤:

4、s1、安全参数预设步骤:预先设定机器人可移动底座之间的最小安全距离阈值d1、机器人工具端之间的最小安全距离阈值d2;

5、s2、实时状态采集步骤:所述plc以预设的固定周期,实时采集每一台工业机器人的可移动底座实时三维坐标、工具端实时三维坐标;

6、s3、目标位置解析步骤:所述plc接收所述上位机下发的各工业机器人的作业任务,解析得到每台工业机器人对应作业任务的可移动底座目标三维坐标、工具端目标三维坐标;

7、s4、双重动态干涉校验步骤:针对待执行作业动作的第一机器人,所述plc以其余所有工业机器人作为第二机器人,基于第二机器人的实时三维坐标、目标三维坐标,以及第一机器人的目标三维坐标,分别执行底座安全距离校验与工具端安全距离校验;

8、s5、干涉区划定与动作控制步骤:若所述底座安全距离校验与工具端安全距离校验均通过,则所述plc判定当前无干涉风险,划定无动态干涉区,向所述第一机器人下发动作允许指令;若任意一项校验未通过,则所述plc判定对应坐标区间为动态干涉区,禁止所述第一机器人执行动作,并根据协同作业系统的实时作业状态下发避让任务指令。

9、作为本发明所述多机器人协同的动态干涉区划定方法的一种优选方案,其中:所述步骤s1中,所述最小安全距离阈值d1、d2为动态可调阈值;所述plc根据工业机器人的实时移动速度、末端负载重量、作业任务类型,实时调整所述d1与d2的数值,其中,所述d1、d2的数值与机器人的移动速度、末端负载重量正相关。

10、作为本发明所述多机器人协同的动态干涉区划定方法的一种优选方案,其中:所述步骤s2之前,还包括坐标系统一校准步骤:所述plc将所有工业机器人的底座坐标系、工具端坐标系统一转换至作业场景的世界坐标系下,确保所有坐标数据处于同一坐标系基准。

11、作为本发明所述多机器人协同的动态干涉区划定方法的一种优选方案,其中:所述协同作业系统包含两台搭载同一直线地轨的工业机器人,两台工业机器人的可移动底座沿所述直线地轨做直线往复运动;

12、所述步骤s4中,所述底座安全距离校验的判定条件为:第一机器人的可移动底座目标三维坐标,与所有第二机器人的可移动底座实时三维坐标、可移动底座目标三维坐标之间的直线距离,均大于所述最小安全距离阈值d1;

13、所述底座安全距离校验的判定条件还包括:沿所述直线地轨的轴向,待动作的第一机器人的可移动底座目标坐标与第二机器人的可移动底座实时坐标、目标坐标的轴向差值的绝对值,均大于所述最小安全距离阈值d1;

14、所述工具端安全距离校验的判定条件为:第一机器人的工具端目标三维坐标,与所有第二机器人的工具端实时三维坐标、工具端目标三维坐标之间的直线距离,均大于所述最小安全距离阈值d2。

15、作为本发明所述多机器人协同的动态干涉区划定方法的一种优选方案,其中:所述步骤s4中,所述工具端安全距离校验,还包括机器人臂身与工具端的三维包络体校验:所述plc预先为每台工业机器人的臂身、工具端建立三维安全包络体模型,实时计算待动作的第一机器人的包络体与所有第二机器人的包络体之间的最小空间距离,当所述最小空间距离大于预设的包络体安全阈值时,判定工具端安全距离校验通过。

16、作为本发明所述多机器人协同的动态干涉区划定方法的一种优选方案,其中:所述协同作业系统包含n台工业机器人,其中n≥3;所述步骤s4中,针对待动作的第一机器人,所述plc依次与其余n-1台第二机器人逐一执行底座安全距离校验与工具端安全距离校验,仅当所有第二机器人的校验均通过时,才判定整体校验通过,向第一机器人下发动作允许指令。

17、作为本发明所述多机器人协同的动态干涉区划定方法的一种优选方案,其中:所述步骤s5中,根据协同作业系统的实时作业状态下发避让任务指令,具体包括:所述plc预先为各工业机器人配置作业优先级,当校验未通过时,判定作业优先级更低的机器人为避让主体,生成对应的安全避让路径与避让点位,控制避让主体移动至安全避让点位,待干涉风险消除后,再恢复原作业任务;当判定存在动态干涉区时,所述plc还对各工业机器人的作业任务进行时序错位调度,在无干涉风险的坐标区间内,控制多台工业机器人并行执行非干涉作业段的任务,在干涉区间内执行串行分时作业,最大化协同作业的整体效率。

18、作为本发明所述多机器人协同的动态干涉区划定方法的一种优选方案,其中:所述plc以10ms-50ms的扫描周期,循环执行所述步骤s2至步骤s5,实时更新各工业机器人的坐标数据,重新执行干涉校验,动态刷新干涉区的划定范围,实现干涉区随机器人的移动实时同步更新。

19、本发明的有益效果:

20、本发明摒弃了固定干涉区的方案,基于机器人的实时位置与目标作业点位动态判定干涉区间,仅当目标点位存在真实干涉风险时才划定干涉区,避免了安全空间的无效占用,允许机器人在无干涉风险的区间内并行作业;

21、同时执行可移动底座与工具端的双重距离校验,既规避了机器人底座的碰撞风险,又杜绝了机械臂、末端工具的干涉问题;同时采用动作前预校验的逻辑,在机器人执行动作前完成目标点位的干涉判定,而非仅检测实时位置,避免了动作过程中突发急停或碰撞,既提升了安全性,又减少了设备损耗;

22、通过动态调整安全距离阈值、作业优先级调度、时序错位作业等优化方案,在保证绝对安全的前提下,最大化压缩安全冗余,实现多机器人协同作业的精细化管控。