[发明专利]一种基于自适应滑模控制器的取料机斗轮位置控制方法

说明书

本发明公开了基于自适应滑模控制器的取料机斗轮位置控制方法。针对复杂环境下取料机斗轮位置控制问题，将自适应控制和滑模控制相结合，提出了一种基于自适应滑模控制器的取料机斗轮位置控制方法。首先，建立了三自由度斗轮取料机动力学模型；接着，基于此模型构造滑模面并设计了滑模控制器；然后，针对传统滑模控制器系统的抖振问题，设计了自适应律进行补偿，减少了输出力矩波动，同时降低了内部参数不确定性对系统的影响，提高了斗轮定位效率，满足斗轮取料机在载料质量波动等复杂环境下快速定位的工作需求。

技术领域

本发明属于工业级取料机技术领域，具体涉及一种基于自适应滑模控制器的取料机斗轮位置控制方法。

背景技术

斗轮取料机是一种大型取料设备，广泛应用于料场中，承担取料任务。由于斗轮取料机的吊臂往往长达十几米，其位置控制不准确容易引发碰撞或斗轮切入堆料过深导致电机堵转等严重后果，而人工操作需要反复调整斗轮位置，严重影响斗轮定位效率，且存在安全风险。因此，研究一种复杂环境下的斗轮取料机位置控制方法，具有重要现实意义和价值。

斗轮取料机具有大车移动平台、可绕Z轴旋转的回转电机，以及可绕Y轴俯仰的液压驱动装置，使得吊臂末端斗轮具有3个自由度空间定点取料的能力。斗轮取料机是一种非线性、强耦合的系统，加上物料质量变化带来的参数不确定性、未建模动态等不利因素，使得对取料机斗轮位置控制变得相当困难。

目前，大多数料场仍采用传统PID方法来控制斗轮位置，其很难克服非线性环节和带干扰项问题，斗轮定位效率远远不够。有使用神经网络、模糊PID控制等不依赖模型参数的控制方法来解决取料机斗轮非线性强耦合的定位控制问题，但是当模型参数或者工作环境发生较大变化时，必须重新调整规则或再次进行学习训练，不利于工业现场的实际应用；也有使用传统滑模控制来解决非线性系统带干扰项问题，取得了一定的定位控制效果，但是仍然无法解决高频切换导致的系统抖振问题。

因此，提出一种基于自适应滑模控制器的取料机斗轮位置控制方法，以克服大惯性机械的非线性动力学特性、载料质量波动等干扰，减少力矩波动和系统抖振，提高斗轮定位效率。

发明内容

发明目的：为了克服现有技术的缺陷和不足，本发明提出了基于自适应滑模控制器的取料机斗轮位置控制方法。

技术方案：为实现上述发明目的，本发明采用如下技术方案：

基于自适应滑模控制器的取料机斗轮位置控制方法，包括如下步骤：

步骤1)将吊臂末端斗轮等效为具有平动-旋转-旋转的三自由度机械臂，并建立斗轮三自由度空间定位的动力学模型，并将动力学模型转换为二阶动态模型；

步骤2)根据给定位置θ_d＝[θ_0d θ_1d θ_2d]^T与实际位置间的误差e，构造滑模面，并设计滑模控制器控制律；

步骤3)在步骤2)滑模控制器控制律的基础上，设计自适应律补偿滑模面抖振项Ksign(s)，整定控制律参数，得到自适应滑模控制器；

步骤4)根据步骤3)所设计的自适应滑模控制器输出的驱动力矩，将其作用于大车平台驱动轮、绕Z轴回转关节、绕Y轴俯仰关节3个执行机构；

步骤5)依据位置检测与姿态识别系统，判断三个自由度位置是否到位，是则结束控制流程，否则跳转到步骤3)。

其中，步骤1)中，斗轮取料机等效为一种具有平动-旋转-旋转的三自由度的机械臂的动力学模型如下：