[发明专利]一种五轴平面机器人及其轴臂相对移动距离的算法

说明书

本发明公开并提供了一种五轴平面机器人及其轴臂相对移动距离的算法。本发明中的五轴平面机器人在原有SCARA上增加一个可水平移动的X轴，扩大平面机器人的工作范围，且机器人的工作更加灵活。本发明中的五轴平面机器人轴臂相对移动距离的算法的理论精度非常高，可间接提高5轴平面关节机器人在工业自动化应用中的精度。本发明适用于工业自动化需要工作范围较大的搬取和装配功能机台领域。

技术领域

本发明涉及一种五轴平面机器人及其轴臂相对移动距离的算法。

背景技术

平面关节型机器人简称SCARA(Selective Compliance Assembly Robot Arm)，具有3个旋转关节，一个移动关节，其中两个旋转关节轴线相互平行，另一旋转关节实现终端节点的360度旋转，拥有XYZ与绕Z轴旋转的四个自由度，由于其中两个旋转关节处于同一水平面，故称为平面关节型机器人，特点是轻便灵敏，适用于平面定位，垂直方向进行装配搬取的作业。现有的SCARA缺点是工作范围较小，在需要较大范围操作的情况下，增大工作范围意味着机器人重量增加，成本增加，失去了轻便灵敏的特点。发明内容

本发明所要解决的技术问题是克服现有技术的不足，提供一种五轴平面机器人及其轴臂相对移动距离的算法。本发明中的五轴平面机器人在原有SCARA上增加一个可水平移动的X轴，扩大平面机器人的工作范围，且机器人的工作更加灵活。本发明中的五轴平面机器人轴臂相对移动距离的算法的理论精度非常高，可间接提高5轴平面关节机器人在工业自动化应用中的精度。

本发明所采用的技术方案是：本发明中的五轴机器人包括升降轴架、水平移动轴架、第一转动臂、第二转动臂以及终端取物臂，所述水平移动轴架适配活动设置在所述升降轴架上，所述第一转动臂的首端活动设置在所述水平移动轴架上，所述第二转动臂的首端活动设置在所述第一转动臂的末端，所述终端取物臂活动设置在所述第二转动臂的末端。

所述升降轴架上设置有升降滑轨、丝杆以及丝杆电机，所述水平移动轴架适配滑动设置在所述升降滑轨上并与所述丝杆相连接，所述丝杆电机设置在所述升降轴架的底端，所述丝杆电机的输出端与所述丝杆的底端相连接。

所述水平移动轴架上设置有水平移动电机、水平滑轨以及水平移动块，所述水平滑轨沿所述水平移动轴架的长度方向设置，所述水平移动块适配滑动设置在所述水平滑轨上，所述水平移动电机设置在所述水平移动轴架的端部，所述水平移动电机的输出端与所述水平移动块相连接。

所述水平移动块的底部垂直设置有第一转动电机，所述第一转动臂的首端适配设置在所述水平移动块的底部并与所述第一转动电机的输出端相连接，所述第一转动臂的首端置于所述第一转动电机与所述水平移动块之间，所述第一转动臂的末端的上表面上垂直设置有第二转动电机，所述第二转动臂的首端适配设置在所述第一转动臂的末端的下表面上并与所述第二转动电机的输出端相连接。

所述第二转动臂的末端上设置有终端转动电机，所述终端取物臂与所述终端转动电机的输出端相连接。

关于上述五轴平面机器人轴臂相对移动距离的算法，设所述水平移动轴架在竖直方向上静止，所述终端取物臂静止，则

所述水平移动轴架的水平移动距离：；

所述第一转动臂移动距离：；

所述第二转动臂移动距离：，

其中R_r1为所述第一转动臂的长度，R_r2为所述第二转动臂的长度，α为移动前所述第一转动臂与所述水平移动轴架的夹角，β为移动后所述第一转动臂与所述水平移动轴架的夹角，puleqt_x为所述水平移动轴架自移动至停止的脉冲当量，puleqt_r1为所述第一转动臂自转动至停止的脉冲当量，puleqt_r2为所述第二转动臂自转动至停止的脉冲当量。