机械手运动方法及其系统的制作方法
【技术领域】
[0001]本发明涉及冲床机械手领域，尤其涉及一种机械手运动方法及其系统。
【背景技术】
[0002]随着工业领域中自动化程度的提高，冲床上下料也开始推广使用机械手，冲压生产线往往由几台冲床组成，将加工毛坯经过连续几道冲压工艺后，制成合格产品，整个工作流程中，单台机械手负责从上一台冲床取出工件放到下一台冲床进行下一道冲压工艺。
[0003]如图1所示，目前机械手上下料的运动过程为:机械手3停在a点取料待机;第一冲床I完成后，机械手3前伸到b点，下降取到工件，再退回到a点;机械手3从a点旋转至(:点放料待机；当第二冲床2中没有料时，机械手3前伸到d点，放下工件，再退回到c点；第二冲床2开始冲压，机械手3从c点回到a点取料待机。但该方法必须停在等待点等待接收下一指令后再进行下一步动作，即一个指令一个动作，无法达到较高的生产效率;进一步的，这种设定躲避障碍的机械手控制方法运用在无障碍冲床上，将复杂化上下料的操作，生产效率低。
[0004]在公开号为103413773A的专利文件中，提出了一种硅片全自动上下料机械手及其运动轨迹控制方法，用于多通道链式制绒、链式清洗和烧结设备中完成硅片的全自动上下料。该机械手包括安装底座、肩关节、大臂、小臂、用于将硅片抓取到多通道太阳能电池片工艺设备上的手爪，通过电机控制大臂、小臂摆动，通过参数化设计和PID控制实现机械手的运动轨迹精确控制。该方案虽然提出了机械手的运动轨迹的控制方法，但针对的是运动到太阳能各个通道的运动轨迹，没有提出有效的运动轨迹，使得机械手的运动达到较高的生产效率。
【发明内容】
[0005]本发明所要解决的技术问题是:提供一种机械手运动方法及其系统，在机械手运动的过程中同时检测信号，提高生产效率。
[0006]为了解决上述技术问题，本发明采用的技术方案为:一种机械手运动方法，包括
[0007]机械手的抓件部向取料点运动，同时检测取料允许信号；
[0008]若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第一等待占.V，
[0009]机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取料点；
[0010]机械手的抓件部向放料点运动，同时检测放料允许信号；
[0011]若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第二等待占.V，
[0012]机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放料点；
[0013]完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动步骤。
[0014]本发明还涉及一种机械手运动系统，包括
[0015]第一检测模块，用于机械手的抓件部向取料点运动，同时检测取料允许信号；
[0016]第一控制模块，用于若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第一等待点；
[0017]第二控制模块，用于机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取料点；
[0018]第二检测模块，用于机械手的抓件部向放料点运动，同时检测放料允许信号；
[0019]第三控制模块，用于若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第二等待点。
[0020]第四控制模块，用于机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放料点；
[0021]执行模块，用于完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动步骤。
[0022]本发明的有益效果在于:机械手边运动边检测，依据在运动过程是否检测到取料允许信号或放料允许信号，控制机械手的实时运动，提高了对机械手控制的灵活性;本发明在运动过程中实时检测信号，相比先检测后运动的运动控制方法可有效节约时间和机械手的执行步骤，提高了生产效率。
【附图说明】
[0023]图1为本发明【背景技术】中机械手的运动示意图；
[0024]图2为本发明一种机械手运动方法的流程图；
[0025]图3为本发明实施例一的方法流程示意图；
[0026]图4为本发明实施例一的机械手的运动示意图；
[0027]图5为本发明实施例一的机械手的参数设置示意图；
[0028]图6为本发明一种机械手运动系统的结构不意图；
[0029]图7为本发明实施例二的系统结构示意图。
[0030]标号说明:
[0031]1、第一冲床;2、第二冲床;3、机械手；
[0032]101、第一检测模块；102、第一控制模块；103、第二控制模块；104、第二检测模块；105、第三控制模块；106、第四控制模块；107、执行模块；108、第五控制模块；109、第六控制模块;110、第一发送模块;111、第二发送模块;112、协调控制模块。
【具体实施方式】
[0033]为详细说明本发明的技术内容、所实现目的及效果，以下结合实施方式并配合附图详予说明。
[0034]本发明最关键的构思在于:机械手边运动边检测取料允许信号或放料允许信号，依据检测信号实现机械手的实时运动控制。
[0035]请参阅图2，一种机械手运动方法，包括
[0036]机械手的抓件部向取料点运动，同时检测取料允许信号；
[0037]若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第一等待占.V，
[0038]机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取料点；
[0039]机械手的抓件部向放料点运动，同时检测放料允许信号；
[0040]若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第二等待占.V，
[0041 ]机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放料点；
[0042]完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动步骤。
[0043]从上述描述可知，本发明的有益效果在于:边运动边检测，提高了对机械手控制的灵活性，相比先检测后运动的运动控制方法可有效节约时间，提高了生产效率。
[0044]进一步地，所述“机械手的抓件部向取料点运动，同时检测取料允许信号”之后，进一步包括:若运动过程中检测到取料允许信号，则控制所述抓件部无停顿地运动到取料点；
[0045]所述“机械手的抓件部向放料点运动，同时检测放料允许信号”之后，进一步包括:若运动过程中检测到放料允许信号，则控制所述抓件部无停顿地运动到放料点。
[0046]由上述描述可知，若在运动过程中检测到取料允许信号或放料允许信号则直接运动到取料点或放料点，不必在等待点停下，节约了机械手在取料点和放料点之间的运动时间，提高了冲压生产线的生产效率。
[0047]进一步地，所述“机械手的抓件部向取料点运动”具体为:机械手的抓件部完成放料动作，从放料点向取料点运动的过程中，经过第二等待点时，所述机械手发送冲压信号至所述放料点对应的冲床。
[0048]进一步地，所述“机械手的抓件部向放料点运动”具体为:机械手的抓件部完成取料动作，从取料点向放料点运动的过程中，经过第一等待点时，所述机械手发送放料允许信号至与其连接的前一台机械手。
[0049]由上述描述可知，可应用于冲压流水线的生产，提高冲压流水线的生产效率。
[0050]进一步地，所述取料点、第一等待点、第二等待点和放料点处于同一直线上。
[0051 ]由上述描述可知，使工件的运动轨迹为一条直线，减少机械手抓取工件后在运动过程中的晃动，防止工件掉落。
[0052]进一步地，所述机械手包括可角度转动的第一旋转部和可伸缩运动的手臂部，所述手臂部的一端与所述第一旋转部连接，所述手臂部的另一端连接所述抓件部，所述抓件部可相对连接点旋转；
[0053]在所述运动过程中，所述第一旋转部依据控制信号旋转预设角度，手臂部前后伸缩预设距离，抓件部旋转预设角度。
[0054]由上述描述可知，在运动过程中，通过第一旋转部、手臂部和抓件部的相应运动，使工件在取料点和放料点之间直线平移并保持方向不变，降低惯性对稳定性和控制精度的影响。
[0055]本发明还提出了一种机械手运动系统，包括
[0056]第一检测模块，用于机械手的抓件部向取料点运动，同时检测取料允许信号；
[0057]第一控制模块，用于若运动过程中没有检测到取料允许信号，则控制所述抓件部停在预设的第一等待点；
[0058]第二控制模块，用于机械手接收取料允许信号后，控制所述抓件部从所述第一等待点运动到取料点；
[0059]第二检测模块，用于机械手的抓件部向放料点运动，同时检测放料允许信号；
[0060]第三控制模块，用于若运动过程中没有检测到放料允许信号，则控制所述抓件部停在预设的第二等待点。
[0061]第四控制模块，用于机械手接收放料允许信号后，控制所述抓件部从所述第二等待点运动到放料点；
[0062]执行模块，用于完成放料动作后，所述机械手继续执行所述机械手的抓件部向取料点运动步骤。
[0063]进一步地，还包括
[0064]第五控制模块，用于若运动过程中检测到取料允许信号，则控制所述抓件部无停顿地运动到取料点；
[0065]第六控制模块，用于若运动过程中检测到放料允许信号，则控制所述抓件部无停顿地运动到放料点。
[0066]进一步地，还包括第一发送模块，用于机械手的抓件部完成放料动作，从放料点向取料点运动的过程中，经过第二等待点时，所述机械手发送冲压信号至所述放料点对应的冲床。
[0067]进一步地，还包括第二发送模块，用于在机械手的抓件部从取料点向放料点运动的过程中，经过第一等待点时，所述机械手发送放料允许信号至与其连接的前一台机械手。
[0068]实施例一
[0069]请参照图2-3，本发明的实施例一为:一种机械手运动方法，用于控制机械手上下料之间的运动，包括如下步骤:
[0070]SI:机械手从取料点对应的冲床上抓取工件后，从取料点向放料点运动，同时检测放料允许信号，当经过预设的第一等待点时，所述机械手发送放料允许信号至与其连接的前一台机械手。