[发明专利]机械手运动方法及其系统

说明书

技术领域

本发明涉及冲床机械手领域，尤其涉及一种机械手运动方法及其系统。

背景技术

随着工业领域中自动化程度的提高，冲床上下料也开始推广使用机械手，冲压生产线往往由几台冲床组成，将加工毛坯经过连续几道冲压工艺后，制成合格产品，整个工作流程中，单台机械手负责从上一台冲床取出工件放到下一台冲床进行下一道冲压工艺。

如图1所示，目前机械手上下料的运动过程为：机械手3停在a点取料待机；第一冲床1完成后，机械手3前伸到b点，下降取到工件，再退回到a点；机械手3从a点旋转至c点放料待机；当第二冲床2中没有料时，机械手3前伸到d点，放下工件，再退回到c点；第二冲床2开始冲压，机械手3从c点回到a点取料待机。但该方法必须停在等待点等待接收下一指令后再进行下一步动作，即一个指令一个动作，无法达到较高的生产效率；进一步的，这种设定躲避障碍的机械手控制方法运用在无障碍冲床上，将复杂化上下料的操作，生产效率低。

在公开号为103413773A的专利文件中，提出了一种硅片全自动上下料机械手及其运动轨迹控制方法，用于多通道链式制绒、链式清洗和烧结设备中完成硅片的全自动上下料。该机械手包括安装底座、肩关节、大臂、小臂、用于将硅片抓取到多通道太阳能电池片工艺设备上的手爪，通过电机控制大臂、小臂摆动，通过参数化设计和PID控制实现机械手的运动轨迹精确控制。该方案虽然提出了机械手的运动轨迹的控制方法，但针对的是运动到太阳能各个通道的运动轨迹，没有提出有效的运动轨迹，使得机械手的运动达到较高的生产效率。

发明内容

本发明所要解决的技术问题是：提供一种机械手运动方法及其系统，在机械手运动的过程中同时检测信号，提高生产效率。

为了解决上述技术问题，本发明采用的技术方案为：一种机械手运动方法，包括

机械手的抓件部向取料点运动，同时检测取料允许信号；

若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第一等待点；

机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取料点；

机械手的抓件部向放料点运动，同时检测放料允许信号；

若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第二等待点；

机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放料点；

完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动步骤。

本发明还涉及一种机械手运动系统，包括

第一检测模块，用于机械手的抓件部向取料点运动，同时检测取料允许信号；

第一控制模块，用于若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第一等待点；

第二控制模块，用于机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取料点；

第二检测模块，用于机械手的抓件部向放料点运动，同时检测放料允许信号；

第三控制模块，用于若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第二等待点。

第四控制模块，用于机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放料点；

执行模块，用于完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动步骤。

本发明的有益效果在于：机械手边运动边检测，依据在运动过程是否检测到取料允许信号或放料允许信号，控制机械手的实时运动，提高了对机械手控制的灵活性；本发明在运动过程中实时检测信号，相比先检测后运动的运动控制方法可有效节约时间和机械手的执行步骤，提高了生产效率。

附图说明

图1为本发明背景技术中机械手的运动示意图；

图2为本发明一种机械手运动方法的流程图；

图3为本发明实施例一的方法流程示意图；

图4为本发明实施例一的机械手的运动示意图；

图5为本发明实施例一的机械手的参数设置示意图；

图6为本发明一种机械手运动系统的结构示意图；

图7为本发明实施例二的系统结构示意图。

标号说明：

1、第一冲床；2、第二冲床；3、机械手；

101、第一检测模块；102、第一控制模块；103、第二控制模块；104、第二检测模块；105、第三控制模块；106、第四控制模块；107、执行模块；108、第五控制模块；109、第六控制模块；110、第一发送模块；111、第二发送模块；112、协调控制模块。