[发明专利]四轴机器人中弹簧储能缸最佳位置配置方法

说明书

本发明公开了一种四轴机器人中弹簧储能缸最佳位置配置方法，其特征是以储能缸下端点在机器人坐标系中的位置以及弹簧储能缸中弹簧初始形变量为位置参数变量，设定大臂驱动扭矩峰值最小化为控制目标，通过萤火虫算法计算获得四轴机器人在不同工作轨迹下的弹簧储能缸的最佳位置参数；基于弹簧储能缸的最佳位置参数，通过设计可调节装置机构实现调节储能缸到优化位置。本发明在平衡大臂扭矩的同时，能有效降低大臂扭矩峰值，提升工作性能，降低成本。

技术领域

本发明涉及四轴机器人中弹簧储能缸的配置方法，更具体地说是四轴机器人中弹簧储能缸的最佳位置配置方法。

背景技术

目前，四轴机器人在各行业中已经普通使用，四轴机器人是在腰部、大臂和小臂之间利用关节进行连接；关节处安装有伺服电机和减速器，包括在大臂与腰部之间设置大臂驱动电机，其大臂驱动电机的输出轴即为大臂驱动轴，根据相应工作任务需求进行控制，使各关节有条不紊地运作以致完成设定的任务；四轴机器人作为码垛机器人在对于过重的货物进行堆垛时，驱动电机的负荷很大，甚至超过电机的最大许用功率，这会对机器人的运作和本体都带来伤害，尤其是大臂驱动电机承受的负荷和不平衡力矩较为明显，为了平衡过载负荷，已有的方法是在机器人大臂的侧部设置弹簧储能缸，以改善机器人在工作中电机的实时扭矩过高的情况。

四轴机器人在搬运货物的过程中，针对不同重量的货物，机器人的大臂、小臂、货物重量所形成的重力矩，以及非线性不平衡力矩都会主要积压释放在机器人大臂驱动电机的输出轴上，长久如此会不仅降低机器人运动性能，还会对机器人大臂部的轴电机造成较大损伤，机器人的动载平衡性能也会变差；设置弹簧储能缸是为平衡机器人大小臂及负载对机器人大臂部的轴所产生的力矩，从而降低对机器人大臂部的轴电机力矩的要求，改善机器人整体动载平衡性，最为理想的状态是作用在机器人大臂部的轴上的偏重力矩能够被弹簧储能缸的弹簧平衡力矩完全抵消。但是，现有技术中的弹簧储能缸只能用来平衡一部分力矩，并且是针对单一工况的固定安装使用，不能适应工况的变化，且并不考虑外部组合调节参数对整体性能影响和参数配比的影响，因此，在不同工作环境下，只能通过改变电机或减速器来调节机器人负载能力，这不仅增加使用成本还限制了机器人在不同工作环境下的迁移使用。

发明内容

本发明是为避免上述现有技术所存在的不足，提供一种四轴机器人中弹簧储能缸最佳位置配置方法，明确位置参数对大臂峰值扭矩的影响，根据不同的工况调整弹簧储能缸至最优位置，从而提升机器人工作性能，减轻重量扭矩和不平衡扭矩对大臂驱动电机等的损害，改善四轴机器人的受力情况，延长设备使用寿命。

本发明为解决技术问题采用如下技术方案：

本发明四轴机器人中弹簧储能缸最佳位置配置方法，所述四轴机器人包括基座、腰身、大臂、小臂和腕部，在机器人大臂的侧部设置有用于提供平衡力矩的弹簧储能缸；本发明方法的特点是：将位于大臂上端的弹簧储能缸上端点设置为可转动的铰接点，将连接在腰部的弹簧储能缸下端点设置为可调结构，所述可调结构是指：在机器人坐标系中，储能缸下端点沿X轴方向距YOZ面的垂直距离f为可调，储能缸下端点沿Z轴方向上距XOY面的垂直距离d为可调；所述机器人坐标系是指：以大臂与腰部的铰接中心为原点O；以大臂驱动电机的输出轴为Y轴，所述Y轴是大臂与腰部之间的铰接轴；以沿大臂竖向中心线、且垂直于Y轴的方向为Z轴；按右手定律确定垂直于YOZ面的方向为X轴；所述弹簧储能缸的缸筒轴线平行于X0Z面；

所述弹簧储能缸的最佳位置配置方法是：

按Kane法建立包含弹簧储能缸的等效支链在内的四轴机器人动力学模型，在所述四轴机器人动力学模型下设置三个位置参数变量，所述三个位置参数变量分别是：储能缸下端点沿X轴方向距YOZ面的垂直距离f、储能缸下端点沿Z轴方向上距XOY面的垂直距离d，以及弹簧储能缸中弹簧初始形变量Δx₀；所述弹簧初始形变量Δx₀是指弹簧预紧状态的形变量；