[发明专利]一种机械手活动控制方法及其系统

说明书

本发明公开一种机械手活动控制方法及其系统，其中，机械手活动控制方法，包括以下步骤：启动距离感应模块，检测待加工产品与机械手之间的距离并获得距离信号；机械手控制终端的信号处理模块传输距离信号至第一毫米波模块；所述第一毫米波模块发射距离信号传输至第二毫米波模块；所述控制芯片模块接收并处理距离信号，并做出摆动指令；所述第二毫米波模块接收到摆动指令，并发射传输至第一毫米波模块；所述第一毫米波模块将接收的摆动指令传输至信号处理模块；所述信号处理模块传输摆动指令至角度感应模块和悬臂摆动模块，以使得机械手机构抓取待加工产品。本发明的技术方案能够更加精准、快速地对待加工产品的抓取加工，替代有线控制方式。

技术领域

本发明涉及工业机器人加工技术领域，具体涉及一种机械手活动控制方法及其系统。

背景技术

在机械零部件生产过程中，有时需要通过机械手抓取零件，实现零件从一个机床到另一个机床的位置变换。在抓取过程中，机械手本身不具备零件位置识别功能，因此抓取时容易发生伸出抓取距离过短，或者控制抓取时间以及效率不高，影响后续的生产加工效率。

发明内容

本发明的主要目的是提出一种机械手活动控制方法，旨在能够更加精准、快速地对待加工产品的抓取加工，替代有线控制方式。

本发明所要解决的上述问题通过以下技术方案以实现：

一种机械手活动控制方法，包括以下步骤：

S1、启动距离感应模块，检测待加工产品与机械手之间的距离并且获得距离信号；

S2、机械手控制终端的信号处理模块采集、处理所接收到的所述距离信号，并传输至第一毫米波模块；

S3、所述第一毫米波模块将处理后的距离信号发射传输至主控制终端的第二毫米波模块；

S4、所述第二毫米波模块将的距离信号传输至控制芯片模块，并作出摆动指令；

S5、所述第二毫米波模块接收到所述摆动指令，并将摆动指令发射传输至所述第一毫米波模块；

S6、所述第一毫米波模块将接收的摆动指令传输至信号处理模块采集、处理；

S7、所述信号处理模块传输摆动指令至角度感应模块和悬臂摆动模块，以使得机械手机构由初始状态摆动至摆动后状态时进行摆动位移抓取待加工产品。

优选的，在所述S3中，S31，所述第一毫米波模块通过同步时钟对距离信号进行采样，再进行编码和转换，然后通过第一无线模块传输至第二毫米波模块的第二无线模块。

优选的，在所述S3中，所述第一毫米波模块通过第一高速时钟对距离信号进行采样，再进行编码和转换，然后再通过第三无线模块传输至所述第二毫米波模块的第四无线模块；

所述第二毫米波模块32的第四无线模块接收到处理后的距离信号数据后将其传输至控制芯片模块31。

优选的，在所述S5中，所述第二毫米波模块通过第二高速时钟对摆动指令进行采样、编码和转换，然后再通过第四无线模块传输至所述第一毫米波模块的第三无线模块；

所述第三无线模块将处理后的摆动指令数据传输至所述信号处理模块。

优选的，在所述S7中，所述角度感应模块包括至少一个第一角度感应模块和第二角度感应模块，所述悬臂摆动模块包括与所述第一角度感应模块相对应的第一悬臂摆动模块和与所述第二角度感应模块相对应的第二悬臂摆动模块；

所述摆动指令驱动第一角度感应模块促使第一悬臂摆动模块带动第一悬臂旋转摆动α角度，同时所述摆动指令还驱动第二角度感应模块促使第二悬臂摆动模块带动第二悬臂旋转摆动β角度。

优选的，在所述S7中，所述初始状态为所述第一悬臂和所述第二悬臂均与所述机械手机构的安装基面垂直时的状态。