关键词:
大型液压机械臂
角度跟踪
末端抑振
末端接触力
高精度控制
摘要:
大型液压机械臂是现代基建行业不可或缺的高端装备,因其具备长臂展、高功率、适用性强等特点,被广泛应用于建筑施工、隧道开采、架桥铺路以及救援抢险等场合。相比于工业机器人,大型液压机械臂一方面具有液压系统的时变非线性与低阻尼等特性;另一方面,随着新材料的使用以及臂杆结构的优化导致其质量变轻,还存在弱刚度引起的柔性变形与振动。因此,相比于工业机器人,大型液压机械臂的自由运动位置控制和约束运动末端接触力控制难度均更高。针对自由运动,本文研究了柔性液压机械臂末端抑振和考虑动力学补偿提升位置控制精度的方法;对于约束运动,本文提出了基于动力学补偿的末端接触力软测量及其高精度控制方法,从而能够满足大型液压机械臂在复杂环境下精确、稳定的作业需求。
本文主要研究内容包括:
1、为建立大型柔性液压机械臂动力学模型,本文根据大型柔性液压机械臂臂杆细长特点,将其假设为Euler-Bernoulli梁。首先,基于假设模态法描述臂杆上任意一点的变形,通过对变形后臂杆的运动分析求解柔性臂的动、势能;其次,对液压驱动系统进行运动分析,通过液压缸输出力求解机械臂各关节的广义驱动力矩,基于拉格朗日方程建立了大型柔性液压机械臂的动力学方程;最后,在Matlab/Simulink中采用了PID控制器对动力学方程进行了数值仿真验证。
2、为提高自由运动下液压机械臂位置控制精度,本文对大型柔性液压机械臂动力学方程进行奇异摄动分解和控制器的设计。根据柔性液压机械臂运动过程中弹性变形与刚体运动耦合双时间尺度特性,采用奇异摄动法将关节运动和弹性振动的时间尺度分离成慢、快双子系统:慢子系统代表大范围刚性运动;快子系统描述由臂杆弹性变形引起的小范围振动。针对慢、快子系统,分别设计了基于慢子系统模型的控制(MBC)和线性二次型最优控制(LQR),通过慢、快两个子系统控制信号的叠加实现了大型柔性液压机械臂的高精度位置跟踪和振动抑制。在混凝土布料机试验平台上将所提出的奇异摄动复合控制算法与传统PID控制算法和刚性MBC控制算法进行对比,验证了本文所提方法的有效性。位置跟踪试验结果表明,相较于传统PID控制,直线轨迹下所提出的奇异摄动复合控制算法关节2、关节3角度误差分别降低了53.14%和64.75%,圆形轨迹下关节2、关节3角度误差分别降低了35.08%和50.81%,均可实现刚性MBC的角度跟踪效果。振动抑制试验结果表明,相较于传统PID控制和刚性MBC控制,直线轨迹下所提出的奇异摄动复合控制算法末端振动加速度分别降低了45.31%和45.92%;在臂杆三处液压缸施加0.1 s的反向激励信号后,末端振动加速度分别降低了78.92%和56.42%;圆形轨迹下,末端振动加速度分别降低了48.21%和50.81%,施加激励信号后,末端振动加速度分别降低了71.12%和60.77%。
3、为提高大型液压机械臂末端接触力控制精度,本文分析了大型液压机械臂与环境接触的动力学特性,设计了基于位置的阻抗控制策略:首先,位置内环采用MBC控制器,补偿机械臂非线性动力学特性,提升阻抗内环位置精度;其次,提出了基于参数辨识和神经网络力矩补偿的末端力软测量方法,对液压机械臂动力学方程进行线性化处理,并采用最小二乘法进行参数辨识,以各关节角度、角速度作为神经网络输入,进行关节力矩补偿,提高了无力传感器工况下末端力估计精度。最后,通过Matlab/Simulink模型进行仿真验证。在500 N和2000 N期望力下,传统阻抗控制方法力跟踪精度分别为0.92%和1.04%,所提出的阻抗控制方法力跟踪精度均提升到0.26%,最大接触力跟踪误差分别可达6.8 N和27.8 N;此外,所提出的末端力软测量方法具有较优的力估计效果,可完全替代力传感器用于阻抗控制,在高负载工况下,末端力跟踪精度高达0.57%。