机械手运动方法及其系统技术方案

本发明专利技术公开了一种机械手运动方法及其系统，方法包括：机械手的抓件部向取料点运动，同时检测取料允许信号；若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第一等待点；机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取料点；机械手的抓件部向放料点运动，同时检测放料允许信号；若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第二等待点；机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放料点；完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动步骤。机械手边运动边检测，提高了对机械手控制的灵活性，可有效节约时间，提高了生产效率。

【技术实现步骤摘要】

本专利技术涉及冲床机械手领域，尤其涉及一种机械手运动方法及其系统。
技术介绍
随着工业领域中自动化程度的提高，冲床上下料也开始推广使用机械手，冲压生产线往往由几台冲床组成，将加工毛坯经过连续几道冲压工艺后，制成合格产品，整个工作流程中，单台机械手负责从上一台冲床取出工件放到下一台冲床进行下一道冲压工艺。如图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、协调控制模块。具体实施方式为详细说明本专利技术的
技术实现思路
、所实现目的及效果，以下结合实施方式并配合附图详予说明。本专利技术最关键的构思在于：机械手边运动边检测取料允许信号或放料允许信号，依据检测信号实现机械手的实时运动控制。请参阅图2，一种机械手运动方法，包括机械手的抓件部向取料点运动，同时检测取料允许信号；若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第一等待点；机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取料点；机械手的抓件部向放料点运动，同时检测放料允许信号；若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第二等待点；机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放料点；完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动步骤。从上述描述可知，本专利技术的有益效果在于：边运动边检测，提高了对机械手控制的灵活性，相比先检测后运动的运动控制方法可有效节约时间，提高了生产效率。进一步地，所述“机械手的抓件部向取料点运动，同时检测取料允许信号”之后，进一步包括：若运动过程中检测到取料允许信号，则控制所述抓件部无停顿地运动到取料点；所述“机械手的抓件部向放料点运动，同时检测放料允许信号”之后，进一步包括：若运动过程中检测到放料允许信号，则控制所述抓件部无停顿地运动到放料点。由上述描述可知，若在运动过程中检测到取料允许信号或放料允许信号则直接运动到取料点或放料点，不必在等待点停下，节约了机械手在取料点和放料点之间的运动时间，提高了冲压生产线的生产效率。进一步地，所述“机械手的抓件部向取料点运动”具体为：机械手的抓件部完成放料动作，从放料点向取料点运动的过程中，经过第二等待点时，所述机械手发送冲压信号至所述放料点对应的冲床。进一步地，所述“机械手的抓件部向放料点运动”具体为：机械手的抓件部完成取料动作，从取料点向放料点运动的过程中，经过第一等待点时，所述机械手发送放料允许信号至与其连接的前一台机械手。由上述描述可知，可应用于冲压流水线的生产，提高冲本文档来自技高网...

【技术保护点】
一种机械手运动方法，其特征在于：包括机械手的抓件部向取料点运动，同时检测取料允许信号；若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第一等待点；机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取料点；机械手的抓件部向放料点运动，同时检测放料允许信号；若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第二等待点；机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放料点；完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动步骤。

【技术特征摘要】
1.一种机械手运动方法，其特征在于：包括
机械手的抓件部向取料点运动，同时检测取料允许信号；
若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第
一等待点；
机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取
料点；
机械手的抓件部向放料点运动，同时检测放料允许信号；
若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第
二等待点；
机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放
料点；
完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动
步骤。
2.根据权利要求1所述的机械手运动方法，其特征在于：所述“机械手的
抓件部向取料点运动，同时检测取料允许信号”之后，进一步包括：若运动过
程中检测到取料允许信号，则控制所述抓件部无停顿地运动到取料点；
所述“机械手的抓件部向放料点运动，同时检测放料允许信号”之后，进
一步包括：若运动过程中检测到放料允许信号，则控制所述抓件部无停顿地运
动到放料点。
3.根据权利要求1所述的机械手运动方法，其特征在于：所述“机械手的
抓件部向取料点运动”具体为：机械手的抓件部完成放料动作，从放料点向取
料点运动的过程中，经过第二等待点时，所述机械手发送冲压信号至所述放料
点对应的冲床。
4.根据权利要求1所述的机械手运动方法，其特征在于：所述“机械手的
抓件部向放料点运动”具体为：机械手的抓件部完成取料动作，从取料点向放
料点运动的过程中，经过第一等待点时，所述机械手发送放料允许信号至与其
连接的前一台机械手。
5.根据权利要求1所述的机械手运动方法，其特征在于：所述取料点、第

\t一等待点、第二等待点和放料点处于同一直线上。
6.根据权利要求1所述的机械手运动方法，其特征在于：所述机械手包括
可角度转动的第一旋转部...

【专利技术属性】
技术研发人员：孙毅，董改田，张卫锋，冷俊，苗立晓，
申请(专利权)人：深圳市华成工业控制有限公司，
类型：发明
国别省市：广东;44