基于输液软袋真空抓取机械手的智能控制方法与流程

摘要: 本发明属于工业机器人抓取控制,具体涉及基于输液软袋真空抓取机械手的智能控制方法。背景技术:1、在输液软袋自动装盘、卸盘的生产过程中,通常采用真空抓取机械手完成输...
基于输液软袋真空抓取机械手的智能控制方法与流程

本发明属于工业机器人抓取控制,具体涉及基于输液软袋真空抓取机械手的智能控制方法。

背景技术:

1、在输液软袋自动装盘、卸盘的生产过程中,通常采用真空抓取机械手完成输液软袋的抬升、横移及放置。该类机械手的末端设有多个吸盘,通常根据真空总管压力判断吸盘组是否完成吸附。为减小部分吸盘空吸或轻微泄漏对抓取过程的影响,现有技术还会提高真空系统的抽气能力,以维持吸盘组的整体真空压差。

2、然而,输液软袋属于内部装有液体的柔性袋体,机械手运动过程中,袋内液体会发生偏移,使不同吸盘区域承担的载荷持续变化。灭菌后的输液软袋表面还可能残留水珠或水膜。当某一吸盘区域发生轻微泄漏时,真空系统的抽气补偿可能使真空总管压力仍保持正常,但该吸盘区域的承载能力已经下降,其载荷会逐渐转移至其他吸盘区域,使载荷接收吸盘区域的保持余量持续降低,最终可能造成多个吸盘区域连续脱附。

3、上述级联脱附一旦发生,输液软袋可能在机械手高速搬运过程中突然掉落,造成袋体破裂、药液泄漏或装盘错位,甚至干扰其他机械手的运行轨迹。现有仅根据真空总管压力判断整体吸附情况的方式,难以及时识别首发失效吸盘区域及载荷转移过程,也无法判断吸盘组还能保持输液软袋的时间,因而难以在整体脱附前选择可及时到达的安全支承位置并调整机械手运动。因此,需要一种能够识别吸盘区域间载荷转移、预测吸盘组剩余保持时间,并根据机械手安全到达时间控制输液软袋安全放置的智能控制方法。

技术实现思路

1、鉴于此,为解决真空抓取机械手抓取输液软袋时,局部吸盘区域发生泄漏但真空总管压力仍保持正常,导致难以及时识别载荷转移及连续脱附风险的问题,现提出基于输液软袋真空抓取机械手的智能控制方法。

2、本发明的目的可以通过以下技术方案实现:基于输液软袋真空抓取机械手的智能控制方法,包括以下步骤:采集各吸盘区域的区域真空压差、区域泄漏流量和区域承载力,确定区域承载比例。

3、在真空总管压力不低于预设整体吸附压力时,根据区域真空压差下降、区域泄漏流量升高及区域承载比例降低的时刻确定首发失效吸盘区域。

4、根据首发失效吸盘区域的区域承载比例降低及其他吸盘区域承载比例升高,确定载荷接收吸盘区域及载荷转移路径。

5、根据载荷转移路径及载荷接收吸盘区域的预设安全保持能力与区域承载力之差,确定吸盘组的剩余保持时间。

6、根据机械手当前位置、当前速度及当前加速度确定各预设安全支承位置的安全到达时间,以安全到达时间与预设安全余量之和小于所述剩余保持时间的预设安全支承位置为目标安全支承位置。

7、控制机械手减速,将输液软袋放置于目标安全支承位置。

8、相较于现有技术,本发明的有益效果如下:本发明分别采集各吸盘区域的区域真空压差、区域泄漏流量和区域承载力,并结合区域承载比例确定首发失效吸盘区域,能够识别被正常真空总管压力掩盖的局部吸盘区域泄漏,减少局部吸附能力下降的漏判。

9、本发明根据首发失效吸盘区域与其他吸盘区域之间的区域承载比例变化确定载荷接收吸盘区域及载荷转移路径,并确定吸盘组的剩余保持时间,使载荷转移的发展过程转化为机械手后续动作的时间依据。

10、本发明将吸盘组的剩余保持时间与各预设安全支承位置的安全到达时间进行比较,选择能够及时到达的目标安全支承位置并控制机械手减速放置输液软袋,从而降低连续脱附造成输液软袋掉落的风险。

1.基于输液软袋真空抓取机械手的智能控制方法,其特征在于,包括:

2.根据权利要求1所述的基于输液软袋真空抓取机械手的智能控制方法,其特征在于,目标安全支承位置的确定包括:

3.根据权利要求2所述的基于输液软袋真空抓取机械手的智能控制方法,其特征在于,减速移动时间的确定包括:

4.根据权利要求1所述的基于输液软袋真空抓取机械手的智能控制方法,其特征在于,区域真空压差、区域泄漏流量和区域承载力的采集包括:

5.根据权利要求1所述的基于输液软袋真空抓取机械手的智能控制方法,其特征在于,区域承载比例的确定包括:

6.根据权利要求1所述的基于输液软袋真空抓取机械手的智能控制方法,其特征在于,首发失效吸盘区域的确定包括:

7.根据权利要求1所述的基于输液软袋真空抓取机械手的智能控制方法,其特征在于,载荷接收吸盘区域及载荷转移路径的确定包括:

8.根据权利要求7所述的基于输液软袋真空抓取机械手的智能控制方法,其特征在于,载荷转移路径的生成还包括:

9.根据权利要求8所述的基于输液软袋真空抓取机械手的智能控制方法,其特征在于,剩余保持时间的确定包括:

10.根据权利要求2所述的基于输液软袋真空抓取机械手的智能控制方法,其特征在于,输液软袋的放置包括: