一种基于自适应滑模控制器的取料机斗轮位置控制方法技术

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

【技术实现步骤摘要】
一种基于自适应滑模控制器的取料机斗轮位置控制方法


[0001]本专利技术属于工业级取料机
，具体涉及一种基于自适应滑模控制器的取料机斗轮位置控制方法。

技术介绍

[0002]斗轮取料机是一种大型取料设备，广泛应用于料场中，承担取料任务。由于斗轮取料机的吊臂往往长达十几米，其位置控制不准确容易引发碰撞或斗轮切入堆料过深导致电机堵转等严重后果，而人工操作需要反复调整斗轮位置，严重影响斗轮定位效率，且存在安全风险。因此，研究一种复杂环境下的斗轮取料机位置控制方法，具有重要现实意义和价值。
[0003]斗轮取料机具有大车移动平台、可绕Z轴旋转的回转电机，以及可绕Y轴俯仰的液压驱动装置，使得吊臂末端斗轮具有3个自由度空间定点取料的能力。斗轮取料机是一种非线性、强耦合的系统，加上物料质量变化带来的参数不确定性、未建模动态等不利因素，使得对取料机斗轮位置控制变得相当困难。
[0004]目前，大多数料场仍采用传统PID方法来控制斗轮位置，其很难克服非线性环节和带干扰项问题，斗轮定位效率远远不够。有使用神经网络、模糊PID控制等不依赖模型参数的控制方法来解决取料机斗轮非线性强耦合的定位控制问题，但是当模型参数或者工作环境发生较大变化时，必须重新调整规则或再次进行学习训练，不利于工业现场的实际应用；也有使用传统滑模控制来解决非线性系统带干扰项问题，取得了一定的定位控制效果，但是仍然无法解决高频切换导致的系统抖振问题。
[0005]因此，提出一种基于自适应滑模控制器的取料机斗轮位置控制方法，以克服大惯性机械的非线性动力学特性、载料质量波动等干扰，减少力矩波动和系统抖振，提高斗轮定位效率。

技术实现思路

[0006]专利技术目的：为了克服现有技术的缺陷和不足，本专利技术提出了基于自适应滑模控制器的取料机斗轮位置控制方法。
[0007]技术方案：为实现上述专利技术目的，本专利技术采用如下技术方案：
[0008]基于自适应滑模控制器的取料机斗轮位置控制方法，包括如下步骤：
[0009]步骤1)将吊臂末端斗轮等效为具有平动
‑
旋转
‑
旋转的三自由度机械臂，并建立斗轮三自由度空间定位的动力学模型，并将动力学模型转换为二阶动态模型；
[0010]步骤2)根据给定位置θ
d
＝[θ
0d θ
1d θ
2d
]T
与实际位置间的误差e，构造滑模面，并设计滑模控制器控制律；
[0011]步骤3)在步骤2)滑模控制器控制律的基础上，设计自适应律补偿滑模面抖振项Ksign(s)，整定控制律参数，得到自适应滑模控制器；
[0012]步骤4)根据步骤3)所设计的自适应滑模控制器输出的驱动力矩，将其作用于大车
平台驱动轮、绕Z轴回转关节、绕Y轴俯仰关节3个执行机构；
[0013]步骤5)依据位置检测与姿态识别系统，判断三个自由度位置是否到位，是则结束控制流程，否则跳转到步骤3)。
[0014]其中，步骤1)中，斗轮取料机等效为一种具有平动
‑
旋转
‑
旋转的三自由度的机械臂的动力学模型如下：
[0015][0016]其中，q＝[x
c
θ1θ2]T
，θ1、θ2分别为连杆1和连杆2的角度位置量，大车运动方程rd为大车轮胎直径，为轮胎转动角速度；取A(q)＝[0 0 0]零空间的基：v为各执行机构的角速度，
[0017][0018]其中，M
11
＝m0+m1+m2，M
12
＝M
21
＝
‑
m2r2cosθ2sinθ1，M
13
＝M
31
＝
‑
m2r2sinθ2cosθ1，
[0019][0020]其中，其中，其中，
[0021]G(
q
)＝[0 0 m2gr
2 cos θ2]T
[0022][0023]其中，τ＝[τ1τ2τ3]，τ1为大车平台驱动轮上的的驱动力矩，τ2、τ3为两旋转关节驱动力矩，M(q)∈R3×3为惯性矩阵。为向心力和科里奥利力矩阵，G(q)是万有引力矢量，B(q)为转换矩阵，τ∈R3为输入力矩矢量，A(q)是额外的约束矩阵，λ是拉格朗日乘子；m0为大车平台质量，m1为连杆1的质量，m2为连杆2的质量，g为重力加速度；连杆1和连杆2的长度分别为l1和l2，转动惯量分别为J1和J2，连杆1质心到回转关节距离为r1，连杆2质心到俯仰关节距离为r2；θ1、θ2分别为连杆1和连杆2的角度位置量，分别为连杆1和连杆2的角速度。
[0024]考虑系统未建模动态和总扰动转换为二阶动态模型：
[0025][0026]其中，表示机械臂系统的未建模动态和总扰动，简化二阶动态模型：
[0027][0028][0029]其中，其中，τ＝[τ1τ2τ3]，τ1为大车平台驱动轮上的的驱动力矩，τ2、τ3为两旋转关节驱动力矩，q＝[x
c
θ1θ2]T
，
[0030]将未建模动态和总扰动作用下模型表示为：
[0031][0032][0033]步骤2)、步骤3)中，设计自适应滑模控制器控制器，选取系统输出向量为：θ＝[θ
0 θ
1 θ2]T
，其中θ0为大车轮胎转动角度，θ1、θ2分别为连杆1和连杆2的角度位置量，θ
d
＝[θ
0d θ
1d θ
2d
]T
为上述角度给定位置；
[0034]位置误差为：
[0035]e＝θ
d
‑
θ
[0036]根据线性滑模面：
[0037][0038]其中C＝diag(c1，c2，c3)，c
i
＞0(i＝1，2，3)为待调节参数，
[0039]对滑模面函数的导数有：
[0040][0041]上式中矩阵参数可能受不确定质量m2影响，不等同于系统标称的参数矩阵，记为可以认为可以认为满足存在各自的上界数，使得满足存在各自的上界数，使得则有：
[0042][0043]其中Θ＝[m
max v
max g
max
]T
，针对的估计设计自适应律为：
[0044][0045]矩阵Γ和P为待整定参数的正特征值对角矩阵，增加自适应律补偿滑模面抖振项Ksign(s)，控制器输出的转矩控制律为：
[0046][0047]其中sign为符号函数，ε为滑模系数矩阵，选择Λ的形式为：
[0048][0049]因此，自适应滑模控制器形式如下：
[0050][0051]实际情况下外部干扰无法准确得到和表示，将控制律写作：
[0052][0053]质量参数不确定情况下的自适应滑模控制器控制律可以写作：
[0054][0055]其中，和为标称本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于自适应滑模控制器的取料机斗轮位置控制方法，其特征在于，所述方法包括以下步骤：步骤1)将吊臂末端斗轮等效为具有平动
‑
旋转
‑
旋转的三自由度机械臂，建立三自由度空间斗轮动力学模型，并将动力学模型转换为二阶动态模型；步骤2)根据给定位置θ
d
＝[θ
0d θ
1d θ
2d
]
T
与实际位置间的误差e，构造滑模面，并设计滑模控制器控制律；步骤3)在步骤2)滑模控制器控制律的基础上，设计自适应律补偿滑模面抖振项Ksign(s)，整定控制律参数，得到自适应滑模控制器；步骤4)将步骤3)中自适应滑模控制器输出的三自由度驱动力矩分别作用于大车平台驱动轮、绕Z轴回转关节、绕Y轴俯仰关节三个执行机构；步骤5)依据位置检测与姿态识别系统，判断三个自由度位置是否到位，是则结束控制流程，否则跳转到步骤2)。2.根据权利要求1所述的基于自适应滑模控制器的取料机斗轮位置控制方法，其特征在于：步骤1)将斗轮取料机视为一类具有三自由度的移动机械臂来建立动力学模型，具体步骤如下：斗轮取料机等效为一种具有平动
‑
旋转
‑
旋转的三自由度的机械臂的动力学模型如下：其中，q＝[x
c
θ1θ2]
T
，θ1、θ2分别为连杆1和连杆2的角度位置量，大车运动方程r
d
为大车轮胎直径，为轮胎转动角速度；取A(q)＝[0 0 0]零空间的基：v为各执行机构的角速度，为各执行机构的角速度，其中，M
11
＝m0+m1+m2，M
12
＝M
21
＝
‑
m2r2cosθ2sinθ1，M
13
＝M
31
＝
‑
m2r2sinθ2cosθ1，，其中，其中，其中，G(q)＝[0 0 m2gr2cosθ2]
T
其中，τ＝[τ1τ2τ3]，τ1为大车平台驱动轮上的的驱动力矩，τ2、τ3为两旋转关节驱动力矩，M(q)∈R3×3为惯性矩阵，为向心力和科里奥利力矩阵，G(q)是万有引力矢量，B(q)为转换矩阵，τ∈R3为输入力矩矢量，A(q)是额外的约束矩阵，λ是拉格朗日乘子；m0为大车平台质量，m1为连杆1的质量，m2为连杆2的质量，g为重力加速度；连杆1和连杆2的长度分别为l1和l2，转动惯量分别为...

【专利技术属性】
技术研发人员：顾扬宸，牛丹，李奇，陈夕松，
申请(专利权)人：南京科远智慧科技集团股份有限公司南京闻望自动化有限公司，
类型：发明
国别省市：