一种五轴平面机器人及其轴臂相对移动距离的算法制造技术

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

An Algorithms for Relative Moving Distance of Five-Axis Planar Robot and Its Arm

The invention discloses and provides an algorithm for calculating the relative moving distance of a five-axis planar robot and its axle arm. The five-axis planar robot in the invention adds a horizontally movable X-axis to the original SCARA, enlarges the working range of the planar robot, and makes the work of the robot more flexible. The algorithm for calculating the relative moving distance of the axle arm of the five-axis planar robot in the present invention has very high theoretical accuracy, and can indirectly improve the accuracy of the five-axis planar joint robot in industrial automation application. The invention is applicable to the field of moving and assembling functional machines with large working range for industrial automation.

【技术实现步骤摘要】
一种五轴平面机器人及其轴臂相对移动距离的算法
本专利技术涉及一种五轴平面机器人及其轴臂相对移动距离的算法。
技术介绍
平面关节型机器人简称SCARA(SelectiveComplianceAssemblyRobotArm)，具有3个旋转关节，一个移动关节，其中两个旋转关节轴线相互平行，另一旋转关节实现终端节点的360度旋转，拥有XYZ与绕Z轴旋转的四个自由度，由于其中两个旋转关节处于同一水平面，故称为平面关节型机器人，特点是轻便灵敏，适用于平面定位，垂直方向进行装配搬取的作业。现有的SCARA缺点是工作范围较小，在需要较大范围操作的情况下，增大工作范围意味着机器人重量增加，成本增加，失去了轻便灵敏的特点。
技术实现思路
本专利技术所要解决的技术问题是克服现有技术的不足，提供一种五轴平面机器人及其轴臂相对移动距离的算法。本专利技术中的五轴平面机器人在原有SCARA上增加一个可水平移动的X轴，扩大平面机器人的工作范围，且机器人的工作更加灵活。本专利技术中的五轴平面机器人轴臂相对移动距离的算法的理论精度非常高，可间接提高5轴平面关节机器人在工业自动化应用中的精度。本专利技术所采用的技术方案是：本专利技术中的五轴机器人包括升降轴架、水平移动轴架、第一转动臂、第二转动臂以及终端取物臂，所述水平移动轴架适配活动设置在所述升降轴架上，所述第一转动臂的首端活动设置在所述水平移动轴架上，所述第二转动臂的首端活动设置在所述第一转动臂的末端，所述终端取物臂活动设置在所述第二转动臂的末端。所述升降轴架上设置有升降滑轨、丝杆以及丝杆电机，所述水平移动轴架适配滑动设置在所述升降滑轨上并与所述丝杆相连接，所述丝杆电机设置在所述升降轴架的底端，所述丝杆电机的输出端与所述丝杆的底端相连接。所述水平移动轴架上设置有水平移动电机、水平滑轨以及水平移动块，所述水平滑轨沿所述水平移动轴架的长度方向设置，所述水平移动块适配滑动设置在所述水平滑轨上，所述水平移动电机设置在所述水平移动轴架的端部，所述水平移动电机的输出端与所述水平移动块相连接。所述水平移动块的底部垂直设置有第一转动电机，所述第一转动臂的首端适配设置在所述水平移动块的底部并与所述第一转动电机的输出端相连接，所述第一转动臂的首端置于所述第一转动电机与所述水平移动块之间，所述第一转动臂的末端的上表面上垂直设置有第二转动电机，所述第二转动臂的首端适配设置在所述第一转动臂的末端的下表面上并与所述第二转动电机的输出端相连接。所述第二转动臂的末端上设置有终端转动电机，所述终端取物臂与所述终端转动电机的输出端相连接。关于上述五轴平面机器人轴臂相对移动距离的算法，设所述水平移动轴架在竖直方向上静止，所述终端取物臂静止，则所述水平移动轴架的水平移动距离：；所述第一转动臂移动距离：；所述第二转动臂移动距离：，其中R_r1为所述第一转动臂的长度，R_r2为所述第二转动臂的长度，α为移动前所述第一转动臂与所述水平移动轴架的夹角，β为移动后所述第一转动臂与所述水平移动轴架的夹角，puleqt_x为所述水平移动轴架自移动至停止的脉冲当量，puleqt_r1为所述第一转动臂自转动至停止的脉冲当量，puleqt_r2为所述第二转动臂自转动至停止的脉冲当量。本专利技术的有益效果是：在本专利技术的五轴机器人中，在第一转动臂与升降轴架之间增设了水平移动轴架，大大地增加了第一转动臂以及第二转动臂的活动范围。本专利技术中的关于五轴机器人的轴臂相对移动距离的算法简易明了，可以直接应用到项目中，并且其理论精度非常高，可间接提高5轴平面关节机器人在工业自动化应用中的精度。附图说明图1是本专利技术的整体示意图;图2是起始时X轴与R1在XY方向坐标上的位置关系；图3是移动前R1与X轴在XY方向坐标上的夹角示意图；图4是移动后R1与X轴在XY方向坐标上的夹角示意图。具体实施方式如图1所示，本专利技术中的五轴机器人包括包括升降轴架1、水平移动轴架2、第一转动臂3、第二转动臂4以及终端取物臂5，所述水平移动轴架2适配活动设置在所述升降轴架1上，所述第一转动臂3的首端活动设置在所述水平移动轴架2上，所述第二转动臂4的首端活动设置在所述第一转动臂3的末端，所述终端取物臂5活动设置在所述第二转动臂4的末端。所述升降轴架1上设置有升降滑轨11、丝杆12以及丝杆电机13，所述水平移动轴架2适配滑动设置在所述升降滑轨11上并与所述丝杆12相连接，所述丝杆电机13设置在所述升降轴架1的底端，所述丝杆电机13的输出端与所述丝杆12的底端相连接。所述水平移动轴架2上设置有水平移动电机21、水平滑轨22以及水平移动块23，所述水平滑轨22沿所述水平移动轴架2的长度方向设置，所述水平移动块23适配滑动设置在所述水平滑轨22上，所述水平移动电机21设置在所述水平移动轴架2的端部，所述水平移动电机21的输出端与所述水平移动块23相连接。所述水平移动块23的底部垂直设置有第一转动电机31，所述第一转动臂3的首端适配设置在所述水平移动块23的底部并与所述第一转动电机31的输出端相连接，所述第一转动臂3的首端置于所述第一转动电机31与所述水平移动块23之间，所述第一转动臂3的末端的上表面上垂直设置有第二转动电机41，所述第二转动臂4的首端适配设置在所述第一转动臂3的末端的下表面上并与所述第二转动电机41的输出端相连接。所述第二转动臂4的末端上设置有终端转动电机51，所述终端取物臂5与所述终端转动电机51的输出端相连接。关于上述五轴平面机器人的轴臂的相对移动距离的算法：在本具体实施例中，设定所述水平移动轴架2为X，所述第一转动臂3为R1，所述第二转动臂4为R2，如图2所示，已知量有：大臂R1长度R_r1mm，小臂R2长度R_r2mm，X轴以简图右方向为正，R1、R2以逆时针方向为正。假设需要5轴平面关节机器人保持现有姿态在水平面上移动dmm，Z轴与R3轴静止，只计算X、R1、R2三轴的相对距离。已知量有：各轴电机当前位置currt_x，currt_r1，currt_r2，单位脉冲；R1、R2保持直线与X轴垂直时的脉冲zero_r1，zero_r2；各轴脉冲当量puleqt_x(mm/pulse)，puleqt_r1(radian/pulse)，puleqt_r2(radian/pulse)。puleqt_x为所述水平移动轴架2自移动至停止的脉冲当量，puleqt_r1为所述第一转动臂3自转动至停止的脉冲当量，puleqt_r2为所述第二转动臂4自转动至停止的脉冲当量。则在X方向上，X轴移动距离：；在Y方向上，如图3所示，计算移动前R1与X轴的夹角α弧度，由计算得：；如图4所示，计算移动后R1与X轴的夹角β弧度，由计算得；计算各轴相对移动距离脉冲：所述水平移动轴架2的水平移动距离：；所述第一转动臂3移动距离：；所述第二转动臂4移动距离：，其中R_r1为所述第一转动臂3的长度，R_r2为所述第二转动臂4的长度。本专利技术适用于工业自动化需要工作范围较大的搬取和装配功能机台领域。本文档来自技高网...

【技术保护点】
1.一种五轴平面机器人，其特征在于：它包括升降轴架（1）、水平移动轴架（2）、第一转动臂（3）、第二转动臂（4）以及终端取物臂（5），所述水平移动轴架（2）适配活动设置在所述升降轴架（1）上，所述第一转动臂（3）的首端活动设置在所述水平移动轴架（2）上，所述第二转动臂（4）的首端活动设置在所述第一转动臂（3）的末端，所述终端取物臂（5）活动设置在所述第二转动臂（4）的末端。

【技术特征摘要】
1.一种五轴平面机器人，其特征在于：它包括升降轴架（1）、水平移动轴架（2）、第一转动臂（3）、第二转动臂（4）以及终端取物臂（5），所述水平移动轴架（2）适配活动设置在所述升降轴架（1）上，所述第一转动臂（3）的首端活动设置在所述水平移动轴架（2）上，所述第二转动臂（4）的首端活动设置在所述第一转动臂（3）的末端，所述终端取物臂（5）活动设置在所述第二转动臂（4）的末端。2.根据权利要求1所述的一种五轴平面机器人，其特征在于：所述升降轴架（1）上设置有升降滑轨（11）、丝杆（12）以及丝杆电机（13），所述水平移动轴架（2）适配滑动设置在所述升降滑轨（11）上并与所述丝杆（12）相连接，所述丝杆电机（13）设置在所述升降轴架（1）的底端，所述丝杆电机（13）的输出端与所述丝杆（12）的底端相连接。3.根据权利要求2所述的一种五轴平面机器人，其特征在于：所述水平移动轴架（2）上设置有水平移动电机（21）、水平滑轨（22）以及水平移动块（23），所述水平滑轨（22）沿所述水平移动轴架（2）的长度方向设置，所述水平移动块（23）适配滑动设置在所述水平滑轨（22）上，所述水平移动电机（21）设置在所述水平移动轴架（2）的端部，所述水平移动电机（21）的输出端与所述水平移动块（23）相连接。4.根据权利要求3所述的一种五轴平面机器人，其特征在于：所述水平移动块（23）的底部垂直设置有第一转动电机（...

【专利技术属性】
技术研发人员：胡凡凡，
申请(专利权)人：珠海市运泰利自动化设备有限公司，
类型：发明
国别省市：广东,44