关键词:
液压系统
串联机器人
运动控制
半实物仿真
摘要:
相对于电驱动机器人,液压伺服驱动机器人因为具备更优秀的负载能力,在矿山、钢铁工业、煤电厂等需要大负载场景的领域有着更广阔的前景。但是由于液压机器人其液压系统呈现非线性、系统参数不固定和惯量大等特点,导致液压机器人会相较电驱动机器人的响应速度慢且高速状态下的末端定位精度较差。本文提出一种面向煤炭卸车场景的液压伺服驱动的串联机器人控制系统,实现液压机器人高精度末端跟踪,本文所完成的主要工作如下:
(1)本文根据煤炭卸车场景,对该场景的实际工况进行研究,分析空载和末端加载两种情况,完成精确计算液压系统参数,实现大负载液压串联机器人的液压系统针对该场景的准确建模,并根据液压系统参数与液压模型完成液压系统的元件选型。
(2)基于D-H(Denavit-Hartenberg)法建立液压串联机器人的连杆坐标系,随后完成忽略液压缸的整机运动学推导,根据运动学推导结果,提出一种根据特定数学逻辑的映射关系,将关节角与液压缸形成关联。另外提出一种新型液压构件整体动力学的推导方式,通过拉格朗日法去求解加入液压缸后对其所属杆件影响较大的关节,并把液压缸分体等效到机器人整体构件中,从而完成一个局部三自由度的动力学,随后把液压缸从机器人整体中简化出来,再通过牛顿-欧拉法完成整体六自由度简化动力学推导,最后将两次动力学结果进行整合输出,从而完成液压机器人整机的完备动力学推导,实现含液压缸动力学输出误差降低约18%,并且完成引入模拟噪声干扰的系统参数辨识。
(3)完成液压机器人整机控制补偿算法设计和框架搭建,首先在外环引入阻抗补偿控制,提升机器人受重力和惯性力干扰的能力。根据目前控制器的实时性和稳定性,并考虑工程实用性,提出一种轻量化顺馈补偿控制,将原本五阶多项式进行降维,实现算力降低,使位置跟随误差绝对值降低约78%。引入动态刚度补偿控制,降低由外负载力引起的位置跟随精度下降,并将为提升控制系统实时性将其进行简化设计,实现相对补偿前最大位置误差绝对值减小66.7%。为进一步提升机器人的末端控制精度,引入大闭环补偿控制,实现末端闭环修正,使末端控制误差降低至毫米级,并改进变速积分解决超调问题。
(4)本文完成机器人控制系统框架的验证与部署,通过将整机算法框架移植到通用控制器上,并完成半实物仿真搭建,并验证其输出准确性。