机械手是一个典型的具有未建模动态、摩擦作用、弹性力和耦合作用等不确定性的非线性系统[1-2]。随着机器人技术的发展,在工业自动化中领域,涂装和焊接等许多复杂的任务都交由能实现高精度轨迹跟踪的机械手来完成[3]。在负荷变动较大的情况下,为了实现机械手大范围运动的精确轨迹跟踪,许多先进控制方法,例如反馈线性化[4]、 模型预测控制[5]、 智能控制[6]、 自适应控制[7]、 滑模控制[8-11]等被应用到机械手的运动控制中。滑模控制因其方法简单、内在的鲁棒性而倍受青睐[9-10]。滑模控制通过不连续反馈控制律,能迫使系统状态运动到滑动模态,这种模态对系统不确定性具有不变性,是实现不确定非线性系统跟踪控制的最佳方法之一,已在机器人、过程控制、航空航天、电力系统等领域[11-12]获得广泛应用。
传统滑模控制的滑模切换面是线性的,系统状态是渐进收敛的,尽管可以通过调节线性滑模参数使得收敛速度加快,但是这种收敛仍是在无限时间内完成的[13]。在高精度的机械手运动控制中,需要较大的控制输入才能实现更快的收敛速度,但常会导致执行器输出饱和。终端滑模控制通过利用非线性滑模面,在较小的控制作用下亦能实现状态快速收敛。文献[14]将关节电机转角和柔性模态变量的线性组合作为柔性机械手系统的输出,通过输入输出线性化,将系统分解为输入输出子系统和零动态子系统两部分.针对输入输出子系统,提出了快速终端滑模控制策略,使得输入输出子系统在有限时间内收敛;Maolin Jin等人提出了一种二关节机械手的实际非奇异终端滑模控制方法[15];文献[16]结合径向基神经网络设计机械手终端滑模控制器,实现了对给定轨迹的跟踪;文献[17]提出了一种连续有限时间机械手控制方案,通过设计非奇异终端滑模,选择适当的分数幂,解决了终端滑模的奇异问题。但上述终端滑模控制存在两个缺点:一是可能激发系统未建模高频振荡的抖振现象,二是必须知道系统的不确定性上界。
为此,本研究针对一类MIMO(multiple-input multiple-output)非线性系统设计了一种自适应二阶终端滑模控制器,采用非奇异终端滑模面设计控制律,控制信号的时间导数作为新的控制输入,因为存在符号函数,该控制输入是不连续的,但经过积分所得的实际控制输入是连续的,因此抖振大大削弱。自适应调节律可估计未知不确定性,因此该自适应调节方法无需预先知道系统的不确定上界。将该控制方法应用于机械手轨迹跟踪控制中,仿真结果验证了其有效性。
1 自适应终端滑模控制器考虑一类MIMO不确定非线性系统
˙x=f(x)+Δf(x)+gu+d(t), | (1) |
式中:x=[x1,x2,x3,…,xn]T∈Rn是状态向量; Δf(x)表示式(1)系统未建模动态或结构变化; g∈Rn×m是已知矩阵; u∈Rm是控制输入; d(t)∈Rn是外部干扰。假设系统不确定性有界并且满足匹配条件,控制目标是在任意初始状态,有限时间内跟踪给定参考信号xd=[x1d,x2d,x3d,…,xnd]T。
跟踪误差定义为
e=x−xd=[x1−x1d,x2−x2d,x3−x3d,…,xn−xnd]T | (2) |
控制目标是设计终端滑模控制器,使得
limt→∞‖e‖=limt→∞‖x−xd‖→0, | (3) |
式中‖·‖表示欧氏范数。
设计过程分为两步。
步骤 1 定义滑模面
σ=[σ1,σ2,…,σm]T=cTe=[c1,c2,…,ci,…,cm]Te=[c1nen+c1(n−1)en−1+…+c11e1c2nen+c2(n−1)en−1+…+c21e1⋮cmnen+cm(n−1)en−1+…+cm1e1], | (4) |
式中 ci=[cin,ci(n-1),…,ci1]T是多项式(5)在左半开平面所有可能的根。
Φ(λ(ei))=cinλn−2+ci(n−1)λn−1+…+ci1λ | (5) |
式中i=1,2,…,m。c的选择决定了收敛到滑模面的速度。对式(4)求一阶时间导数
˙σ=cT˙e=cT(˙x−˙xd) | (6) |
由式(1)和式(6)得:
˙σ=cT(f(x)+Δf(x)+d(t)+gu−˙xd) | (7) |
对式(7)求导数:
¨σ=cT(˙f(x)+Δ(x)+(t)+g−˙xd) | (8) |
步骤2设计非奇异终端滑模面
s=σ+β˙σp/q | (9) |
式中: β=diag(β1,β2,…,βn)是正常数;p、q是正奇数并且满足1<p/q <2。线性滑模面σ与非奇异终端滑模面s结合实现终端滑模控制。因为s在有限时间内到达零,σ和˙σ必定会到达零,跟踪误差e会渐近收敛到零。
式(9)的时间导数为
˙s=˙σ+β˙σp/q−1¨σ=βpq˙σp/q−1(¨σ+β−1(pq)−1˙σ2−(p/q)) | (10) |
把式(8)代入式(10)得:
˙s =β(pq)˙σp/q−1(cT(˙f(x)+Δ˙f(x)+˙d(t)+g˙u−¨xd)+β−1(pq)−1˙σ2−(p/q)) | (11) |
假设 1 Δ˙f(x),˙d(t)有界且满足:
‖Δ˙F(x)‖=‖cT(Δ˙f(x)+d(t))‖<r∑i=0ˉBi‖x‖i,r=0,1,…,n, | (12) |
式中,Bi是未知正常数,在实际控制系统中,由于不确定项结构复杂,Bi的值不易获得; r是设计者根据系统可能受扰动的相对阶确定。设计传统滑模控制器时,通常假设复合扰动上界满足一定条件,例如,r=0,干扰是周期性的,其值可由已知常数表示,r=1时,包含更多的干扰类型。
定理1给出自适应二阶终端滑模控制器,其控制输入为控制信号的积分值,是连续的,可大大削弱抖振,系统的不确定上界值可由自适应调节律估计。
定理 1 考虑不确定系统(1),如果非奇异终端滑模面选取为式(9),并且控制律设计为
u=ueq+uswt | (13) |
跟踪误差动态式(6)能够渐进收敛到零。其中:ueq是滑模控制中等效控制部分,迫使状态轨迹滑动到滑模面; uswt是滑模切换控制,在干扰存在时,维持滑模运动。
˙ueq由˙s=0求得:
˙ueq=−(cTg)−1[cT˙f(x)−cT¨xd+β−1(pq)−12−(p/q)] | (14) |
ueq=−(cTg)−1∫t0[cT˙f(x)−cT¨xd+β−1(pq)−1˙σ2−(p/q)]dζ | (15) |
˙uswt=−(cTg)−1[(ˉB0+ˉB1‖x‖)sign(s)+εs], | (16) |
uswt=−(cTg)−1∫t0[(ˉB0+ˉB1‖x‖)sign(s)+εs]dζ, | (17) |
式中,cTg是非奇异的; B0,B1和ε=diag(ε1…εm)是设计参数。
实际应用中,不确定项(B0+B1‖x‖)的界通常是未知的,因此设计自适应律来估计B0和B1,控制律进一步表示为:
{u=ueq+uswt,ueq=−(cTg)−1∫t0[cT˙f(x)−cT¨xd+β−1(pq)−1˙σ2−(p/q)]dζ,uswt=−(cTg)−1∫t0[(ˆˉB0+ ˆˉB1‖x‖)sign(s)+εs]dζ, | (18) |
式中,B0e与B1e用来估计B0与B1的上界并且满足假设1,‖cT(Δ˙f(x)+d(t))‖ <B0+B1‖x‖。定义自适应误差0=B0e-˜ˉB0,˜ˉB1=B1e-1。B0e,B1e由以下自适应律估计:
B0e=1ν0(pq)‖β‖‖˙σ(p/q)−1s‖, | (19) |
B1e=1ν1(pq)‖β‖‖˙σ(p/q)−1s‖‖x‖, | (20) |
式中,ν0和ν1是正调节参数。
证明 考虑如下Lyapunov函数:
V(t)=12sTs+12μ0 ˜ˉB 20+12μ1 ˜ˉB21 | (21) |
结合式(8),(10)和(15),V(t)的时间导数为
˙V (t)=sT˙s+μ0˜ˉB 0˙B0e+μ1 ˜ˉB1˙B1e=βpq˙σ(p/q)−1sT¨σ+β−1(pq)−1˙σ2−(p/q)+μ0(B0e−ˉB0)˙B0e+μ1(B1e−ˉB1)˙B1e | (22) |
结合式(13)~(16)得:
˙V(t)=βpq(p/q)−1σT[cT(ddt f(x)+ddtΔf(x)+˙d(t)⏟c−TΔ˙F(x)+g˙u−¨xd)+β−1pq−1˙σ2−(p/q)]+ μ0ν−10(B0e−ˉB0)(pq)β‖˙σ(p/q)−1s‖+μ1ν−11 (B0e1−ˉB1)(pq)β‖˙σ(p/q)−1s‖‖x‖ | (23) |
结合式(15),(12)得:
˙V(t)=βpq˙σ(p/q)−1sT[ΔF(x)−εs−(B0e+B1e‖x‖)sign(s)]+ μ0ν−10 (B0e−ˉB0)(pq)‖β‖‖˙σ(p/q)−1s‖+μ1ν−11 (B1e−ˉB1)(pq)‖β‖‖˙σ(p/q)−1s‖‖x‖ | (24) |
˙V(t)≤‖β‖(pq)‖˙σ(p/q)−1s‖[‖ΔF(x)‖‖s‖−‖(B0e+B1e‖x‖)‖‖s‖+ μ0ν−10‖ (B0e−ˉB0)‖‖s‖+μ1ν−11 ‖(B1e−ˉB1)‖‖s‖‖x‖] | (25) |
˙V(t)≤‖ΔF(x)‖‖s‖−‖(B0e+B1e‖x‖)‖‖s‖− (‖B1e−ˉB0‖)‖s‖+μ0ν−10 (‖B1e−ˉB0‖)‖s‖+μ1ν−11 ‖(B1e−ˉB1)‖‖s‖‖x‖ | (26) |
˙V(t)≤−[‖(ˉB0+ˉB1‖x‖)‖−‖Δ˙F(x)‖]‖s‖−‖(B0e−ˉB0)‖(‖s‖−μ0ν−10‖s‖)−‖(B1e−ˉB1)‖(‖s‖‖x‖−μ0ν−10 ‖s‖‖x‖)≤−βσ√2‖s‖√2−βγ√2μ−10 ‖˜ˉB0‖√μ02−βδ2μ−11 ‖˜ˉB1‖√μ12 | (27) |
式中,βσ=‖(B0+B1‖x‖)‖-‖Δ˙F(x)‖; βγ=(‖s‖-μ0ν0-1 ‖s‖); βδ=(‖s‖-μ0ν0 -1‖s‖)‖x‖。因此,当˙B0e=(1/ν0)(p/q)‖β‖‖˙σ(p/1)-1s‖,˙B1e=(1/ν1)(p/q)‖β‖‖˙σ(p/q)-1s‖‖x‖,{‖(B0+B1‖x‖)‖-‖Δ˙F(x)‖}>0,μ0ν0-1 <1,μ1ν1-1 <1成立,有
˙V(t)≤−min{√2βσ,βγ√2μ−10 ,βδ√2μ−11 }‖s‖√2+√μ02‖˜ˉB0‖+√μ12‖˜ˉB1‖≤−βcV1/2(t), | (28) |
式中,
注 1 当‖s‖=0可达到时,上述方法是适用的,但在实际的滑模控制中,由于非线性和切换的滞后性,‖s‖并不能在有限时间内精确为零,因此自适应参数B0e,B1e可能会无限的变大,利用如下死区技术调整自适应调节律可以解决这个问题[18-19]。
B0e={1ν0(pq)‖β‖‖˙σ(p/q)−1s‖,‖s‖≥ζ;0,‖s‖<ζ | (29) |
B1e={1ν1(pq)‖β‖‖˙σ(p/q)−1s‖‖x‖,‖s‖≥ζ;0,‖s‖<ζ | (30) |
式中ζ是小的正常数。
2 机械手轨迹跟踪自适应终端滑模控制器设计M(q)¨q+C(q,˙q)˙q+G(q)=τ+τd, | (31) |
式中,q、˙q、¨q分别表示关节的位置、速度、加速度;M(q)=M0(q)+ΔM(q)∈Rn×n是机械手惯性矩阵;C(q,˙q)=C0(q,˙q)+ΔC(q,˙q)∈Rn×n是离心力和哥氏力;G(q)=G0(q)+ΔG(q)∈Rn表示重力项;τ∈Rn是控制力矩;τd是干扰力矩向量;M0(q),C0(q,˙q),G0(q)是标称值;ΔM(q)、ΔC(q,˙q)、ΔG(q)表示系统矩阵摄动。则机械手动态模型可写为
M0(q)¨q+C0(q,˙q)˙q+G0(q)=τ+τd+F(q,˙q,¨q) | (32) |
式中,F(q,˙q,¨q)=-ΔM(q)-ΔC(q,˙q)-ΔG(q)∈Rn是系统复合不确定性,满足
‖F(q,˙q,¨q)‖<ρ0+ρ1‖q‖+ρ2‖˙q‖2 | (33) |
式中ρ0、 ρ1、 ρ2是正常数。
控制目标是使得机械手跟踪参考轨迹,定义qd和q是期望的和实际的位置矢量,跟踪误差及其导数定义为:e=qd-q,˙e=˙qd-˙q,¨e=¨qd-¨q,结合式(32),得
¨e=M−10(q)[τ+τd+F(q,˙q,¨q)−C0(q,˙q)+G0(q)]−¨qd | (34) |
对式(34)求导数:
ddt¨e= M−10 (q)[˙τ+˙τd+˙F(q,˙q,¨q)−ddt(C0(q,˙q)˙q+G0(q))]+ ˙M−10 (q)[τ+τd+F(q,˙q,¨q)−C0(q,˙q)˙q+G0(q)]−ddt¨qd= M−10(q)[˙τ−ddt(C0(q,˙q)˙q+G0(q))]+˙M−10 (q)[τ−C0(q,˙q)˙q−G0(q)]−ddt¨qd+ M−10 (q)˙τd+M−10 (q)+˙F(q,˙q,¨q)+˙M−10(q)τd+˙M−10 (q)F(q,˙q,¨q)= M−10 (q)[˙τ−ddt(C0(q,˙q)˙q+G0(q))]+˙M−10(q)[τ−C0(q,˙q)˙q−G0(q)]−ddt¨qd+ˉF(q,˙q,¨q), | (35) |
式中F(q,˙q,¨q)=M0-1 (q)˙τd+M0-1 (q)˙F(q,˙q,¨q)+˙M0-1(q)τd+˙M0-1(q)F(q,˙q,¨q)。因此
‖ˉF(q,˙q,¨q)‖<ˉB0+ˉB1‖q‖+ˉB2‖˙q‖2 | (36) |
式中,B0、B1、B2是正常数。
注 2 因机械手物理结构有其制约范围,而且干扰力矩τd也是有界的,式(36)是有效的。
定义线性滑模面:
σ=˙e+βe, | (37) |
式中 β=diag(β11,…,β1n)是设计矩阵。式(37)的一阶和二阶导数为
{˙σ=¨e+β˙e,¨σ=ddt¨e+β¨e=ddt(¨q−¨qd)+β¨e | (38) |
n关节机械手的非奇异终端滑模面选取为
s=σ+K˙σp/q, | (39) |
式中K=diag(k11,…,k1n)是设计矩阵。
对式(39)求导数:
˙s=˙σ+(p/k)K˙σp/q−1¨σ=(p/q)K˙σp/q−1(¨σ+(q/p)K−1˙σ2−p/q), | (40) |
为保证收敛误差为零,控制力矩设计为
˙τ=˙u0+˙u1, | (41) |
˙u0=M0(q)ddt¨qd+ddt[C0(q,˙q)˙q+G0(q)]−((q/p)K−1M0˙σ2−p/q)−βM0¨e−M0˙M−10 (τ−C0(q,˙q)˙q−G0(q)), | (42) |
˙u1=−K∗M0(q)s−M0(q)(ˉB0+ˉB1‖q‖+ˉB2‖˙q‖2)sign(s), | (43) |
式中K*=-diag(k11*,…,k1n*),是正定矩阵。因为机械手精确数学模型难以得到,B0、B1和B2的计算较为复杂,为此,设计自适应调节律对这些值进行估计,式(43)调整为
˙u1=−K∗M0(q)s−M0(q)(B0e+B1e‖q‖+B2e‖˙q‖2)sign(s) | (44) |
定义自适应误差 ˜ˉB0=B0e-B0,˜ˉB1=B1e-B1,˜ˉB2=B2e-B2,考虑‖s‖不能在有限时间内精确为零,利用死区技术,参数B0e、B1e、B2e采用如下自适应律估计:
˙B0e=ϑ1(pq)‖K‖‖(p/q)−1s‖,‖s‖≥ζ; 0,‖s‖<ζ | (45) |
˙B1e={ϑ1(pq)‖K‖‖˙σ(p/q)−1s‖‖q‖,‖s‖≥ζ;0,‖s‖<ζ | (46) |
˙B2e={ϑ2(pq)‖K‖‖˙σ(p/q)−1s‖‖˙q‖2,‖s‖≥ζ;0,‖s‖<ζ | (47) |
式中,调节参数ϑ0、ϑ1、ϑ3是正数。
定义Lyapunov函数Vm分析系统稳定性:
Vm=12[sTs+γ0 ˜ˉB20+γ1˜ˉB21+γ2˜ˉB22], | (48) |
对式(48)求导,并结合式(40)可得:
˙Vm=sT+γ0 ˜ˉB 0˙B0e+γ1˜ˉB1˙B1e+γ2˜ˉB2˙B2e=(p/k)K˙σp/q−1sT(¨σ+(q/p)K−1˙σ2−p/q)+γ0(B0e−˜ˉB0)B0e+γ1(B1e−˜ˉB1)˙B1e+γ2(B2e−˜ˉB2)˙B2e | (49) |
结合式(35)和式(38)得:
˙Vm=(p/q)K˙σp/q−1sT{M−10(q)[˙τ−ddt(C0(q,˙q)˙q+G0(q))]+ M−10(q)[τ−C0(q,˙q)˙q−G0(q)]−ddt¨qd+(q,˙q,¨q)}+ ((B0e−ˉB0)γ0ϑ0(q/p)‖K‖‖˙σ(p/q)−1s‖+ ((B1e−ˉB1)γ1ϑ1(q/p)‖K‖‖˙σ(p/q)−1s‖‖q‖+ ((B2e−ˉB2)γ2ϑ2(q/p)‖K‖‖˙σ(p/q)−1s‖‖˙q‖2 | (50) |
利用式(41)、(42)和(44)得:
˙Vm≤(p/q)‖K‖‖˙σ(p/q)−1s‖[‖˙F(q,˙q,¨q)‖‖s‖−K∗‖s‖−‖(B0e+B1e‖q‖+B2e‖˙q‖2)‖‖s‖+ ‖(ˉB0+ˉB1‖q‖+ˉB2‖˙q‖2)‖‖s‖−‖(ˉB0+ˉB1‖q‖+ˉB2‖˙q‖2)‖‖s‖+(‖B0e−ˉB0‖)γ0ϑ0‖s‖+(‖B1e−ˉB1‖)γ1ϑ1‖s‖‖q‖+(‖B2e−ˉB2‖)γ2ϑ2‖s‖‖˙q‖2]≤(−[‖(ˉB0+ˉB1‖q‖+2‖˙q‖2)‖−‖(q,˙q,¨q)‖]⏟βσ1‖s‖−(‖B0e−ˉB0‖)[‖s‖−γ0ϑ0‖s‖]⏟βγ1−(‖B1e−ˉB1‖)[‖q‖‖s‖−γ1ϑ1‖q‖‖s‖]⏟βδ1−(‖B2e−ˉB2‖)[‖˙q‖‖s‖−γ2ϑ2‖q‖2‖s‖]⏟βρ1≤−βσ1√2‖s‖√2−βγ1√2γ0 ˜ˉB0√2γ0−βδ1√2γ1 ˜ˉB1√2γ1−βρ1√2γ2 ˜ˉB2√2γ2 | (51) |
因此,
˙Vm≤−min{√2βσ1,√2γ−10 βγ1,√2γ−11 βδ1,√2γ−12 βρ1}‖s‖√2+√γ0√2‖˜ˉB0‖+√γ1√2‖˜ˉB1‖+√γ2√2‖˜ˉB2‖≤−βc0V1/2(t) | (52) |
式中,
图 1为二关节机械手结构示意图,所提出的自适应二阶终端滑模控制器应用于该二关节机械手的轨迹跟踪,仿真基于Matlab/simulink实现,仿真步长设置为0.004 s。
![]() |
图 1 二关节机械手结构 Figure 1 Structrue of a two-link robotic manipulator |
针对二关节机械手动态方程,相关参数为
M(q)=[(m1+m2)l21+m2l22+2m2l1l2c2+J1m2l22+m2l1l2c2m2l22+m2l1l2c2m2l22+J2], C(q,˙q)˙q=[−m2l1l2s2˙q22−2m2l1l2s2˙q1˙q2m2l1l2s2˙q22], |
令x1(t)=q1(t),x2(t)=1(t),x3(t)=q2(t),x4(t)={\dot{q}}2(t),二关节机械手的物理参数分别为l1=1 m,l2=0.85 m,J1=5 kg·m,J2=5 kg·m,m1=0.5 kg,m2=1.5 kg,关节的标称质量1=0.4 kg,2=1.2 kg,g=9.81 m/s2。 参考信号qd1=sin(t),qd2=sin(t),初始状态为:q1(0)=0.5,q2(0)=-0.5,{\dot{q}}1(0)=0,{\dot{q}}2(0)=0,外部干扰看作为:τd1=1.5sin(t)+0.5cos(100πt),τd2=sin(2t)+0.5cos(100πt),r=0,控制器参数设计为p=5,q=3,K=diag(0.023,0.023),β=diag(45,45),ε=0.005,K*=diag(60,60),自适应律设计为
\begin{align} & {{{\dot{B}}}_{0e}}=\left\{ \begin{matrix} 1.74\left\| K \right\|\left\| {{{\dot{\sigma }}}^{\left( p/q \right)-1}}s \right\|, & \left\| s \right\|\ge 0.000\text{ }5, \\ 0, & \left\| s \right\| <0.000\text{ }5 \\ \end{matrix} \right.~ \\ & {{{\dot{B}}}_{1e}}=\left\{ \begin{matrix} 1.45\left\| K \right\|\left\| {{{\dot{\sigma }}}^{\left( p/q \right)-1}}s \right\|\left\| q \right\|, & \left\| s \right\|\ge 0.000\text{ }5; \\ 0, & \left\| s \right\|<0.000\text{ }5 \\ \end{matrix} \right.~ \\ & {{{\dot{B}}}_{2e}}=\left\{ \begin{matrix} 3.30\left\| K \right\|\left\| {{{\dot{\sigma }}}^{\left( p/q \right)-1}}s \right\|{{\left\| {\dot{q}} \right\|}^{2}}, & \left\| s \right\|\ge 0.000\text{ }5; \\ 0, & \left\| s \right\|<0.000\text{ }5 \\ \end{matrix} \right. \\ \end{align} |
初始值取B0e(0)=1,B1e(0)=1,B2e(0)=1。
为对比控制性能,亦对文献[21]非奇异终端滑模控制方法进行仿真,控制器设计为
\left\{ \begin{matrix} {{\tau }_{f}}={{C}_{0}}\left( q,\dot{q} \right)\dot{q}+{{G}_{0}}\left( q \right)+{{M}_{0}}\left( q \right){{{\ddot{q}}}_{d}}+{{u}_{a}}+{{u}_{b}},~ \\ {{u}_{a}}=-\frac{q}{p}{{M}_{0}}\left( q \right){{K}^{-1}}{{{\dot{e}}}^{2-p/q}}, \\ {{u}_{b}}=-\frac{p{{\left[ {{s}^{T}}Kdiag\left( {{{\dot{e}}}^{p/q-1}}M_{0}^{-1}\left( q \right) \right) \right]}^{T}}}{q\left\| {{s}^{T}}Kdiag\left( {{{\dot{e}}}^{p/q-1}}M_{0}^{-1}\left( q \right) \right) \right\|}\left[ \left\| s \right\|\left\| Kdiag\left( {{{\dot{e}}}^{p/q-1}} \right)M_{0}^{-1}\left( q \right) \right\|\left( {{\rho }_{0}}+{{\rho }_{1}}\left\| {\dot{q}} \right\|+{{\rho }_{2}}{{\left\| {\dot{q}} \right\|}^{2}} \right) \right] \\ \end{matrix} \right. | (53) |
两种控制器作用下,跟踪响应和控制输入分别如图 2~5所示,通过观察分析可得,两种方法作用下都有良好的跟踪性能,但如图 4所示,非奇异终端滑模控制方法下控制抖振严重,关节1、关节2的控制输入在抖振幅值约为±0.5的范围内高频振荡,极易引起执行结构损坏,而在本研究所提出方法下,控制输入作用连续,如图 5所示,抖振现象大大减少,控制作用连续、平滑,而且,本研究所提方法不需要已知不确定性上界,参数B0e,B1e,B2e估计值如图 6所示。
![]() |
图 2 本研究所提算法下机械手轨迹跟踪 Figure 2 Trajectory tracking response of robotic manipulator under the proposed algorithm |
![]() |
图 3 文献[21]所提算法下机械手轨迹跟踪 Figure 3 Trajectory tracking response of robotic manipulator under the controller in [21] |
![]() |
图 4 所提算法下控制输入 Figure 4 Control input under the controller in [21] |
![]() |
图 5 本研究所提算法下控制输入 Figure 5 Control input under the proposed algorithm |
![]() |
图 6 本研究所提算法下参数估计值 Figure 6 Estimated parameters under the proposed algorithm |
本研究针对具有不确定性的机械手操作系统提出一种自适应终端滑模控制方案。首先针对一类MIMO非线性不确定系统设计了自适应终端滑模控制器,不连续控制包含在控制输入的微分项,使得实际控制作用连续,设计自适应律克服系统不确定性上界未知问题,然后针对机械手系统设计自适应终端滑模轨迹跟踪控制器,最后针对二关节机械手的仿真结果验证了所提出算法的有效性,并且与一种非奇异终端滑模控制方法进行对比研究,表明所提控制方案在削弱控制抖振、不需要已知不确定上界方面的优越性,实现了机械手轨迹的高精度跟踪。
[1] | GALICKI M. Finite-time control of robotic manipulators[J]. Automatica , 2015, 51 : 49-54 DOI:10.1016/j.automatica.2014.10.089 |
[2] | VERRELLI C M, PIROZZI S, TOMEI P, et al. Linear repetitive learning controls for robotic manipulators by padé approximants[J]. IEEE Transactions on Control Systems Technology , 2015, 23 (5) : 2063-2070 DOI:10.1109/TCST.2015.2396012 |
[3] |
孟健, 李贻斌, 李彬. 四足机器人跳跃步态控制方法[J].
山东大学学报(工学版) , 2015, 45 (3) : 28-34 MENG Jian, LI Yibin, LI Bin. Bound gait controlling method of quadruped robot[J]. Journal of School of Shandong University (Engineering Science) , 2015, 45 (3) : 28-34 |
[4] | PARK C W. Robust stable fuzzy control via fuzzy modeling and feedback linearization with its applications to controlling uncertain single-link flexible joint manipulators[J]. Journal of Intelligent and Robotic Systems , 2004, 39 (2) : 131-147 DOI:10.1023/B:JINT.0000015344.84152.dd |
[5] | NIKDEL N, NIKDEL P, BADAMCHIZADEH M A, et al. Using neural network model predictive control for controlling shape memory alloy-based manipulator[J]. IEEE Transactions on Industrial Electronics , 2014, 61 (3) : 1394-1401 DOI:10.1109/TIE.2013.2258292 |
[6] | LI Z, YANG C, SU C Y, et al. Decentralized fuzzy control of multiple cooperating robotic manipulators with impedance interaction[J]. IEEE Transactions on Fuzzy Systems , 2015, 23 (4) : 1044-1056 DOI:10.1109/TFUZZ.2014.2337932 |
[7] | LI Z, DENG S, SU C Y, et al. Decentralized adaptive control of cooperating robotic manipulators with disturbance observers[J]. IET Control Theory & Applications , 2014, 8 (7) : 515-521 |
[8] |
翟伟娜, 葛运旺, 宋书中. 基于改进趋近律的机械手滑模控制[J].
信息与控制 , 2014, 43 (3) : 300-305 ZHAI Weina, GE Yunwang, SONG Shuzhong. Sliding mode control for robotic manipulators based on the improved reaching Law[J]. Information and Control , 2014, 43 (3) : 300-305 |
[9] | LI F, WU L, SHI P, et al. State estimation and sliding mode control for semi-Markovian jump systems with mismatched uncertainties[J]. Automatica , 2015, 51 : 385-393 DOI:10.1016/j.automatica.2014.10.065 |
[10] |
刘向杰, 韩耀振. 基于连续高阶模滑的多机电力系统励磁控制[J].
山东大学学报 (工学版) , 2016, 46 (2) : 64-71 LIU Xiangjie, HAN Yaozhen. Multi-machine power system excitation control based on continuous higher-order sliding mode[J]. Journal of School of Shandong University (Engineering Science) , 2016, 46 (2) : 64-71 |
[11] | HAN Y, LIU X. Continuous higher-order sliding mode control with time-varying gain for a class of uncertain nonlinear systems[J]. ISA Transactions , 2016, 62 : 193-201 DOI:10.1016/j.isatra.2016.02.005 |
[12] | LIU X, HAN Y. Decentralized multi-machine power system excitation control using continuous higher-order sliding mode technique[J]. International Journal of Electrical Power & Energy Systems , 2016, 82 : 76-86 |
[13] | YANG J, SU J, LI S, et al. High-order mismatched disturbance compensation for motion control systems via a continuous dynamic sliding-mode approach[J]. IEEE Transactions on Industrial Informatics , 2014, 10 (1) : 604-614 DOI:10.1109/TII.2013.2279232 |
[14] |
张德江, 张袅娜, 冯勇. 参数不确定柔性机械手的快速终端滑模控制[J].
控制与决策 , 2010, 25 (3) : 433-436 ZHANG Dejiang, ZHANG Niaona, FENG Yong. Fast terminal sliding mode control for flexible manipulators with uncertain parameters[J]. Control and Decision , 2010, 25 (3) : 433-436 |
[15] | JIN M, LEE J, CHANG P H, et al. Practical nonsingular terminal sliding-mode control of robot manipulators for high-accuracy tracking control[J]. IEEE Transactions on Industrial Electronics , 2009, 56 (9) : 3593-3601 DOI:10.1109/TIE.2009.2024097 |
[16] | WANG L, CHAI T, ZHAI L. Neural-network-based terminal sliding-mode control of robotic manipulators including actuator dynamics[J]. IEEE Transactions on Industrial Electronics , 2009, 56 (9) : 3296-3304 DOI:10.1109/TIE.2008.2011350 |
[17] | FENG Y, YU X, MAN Z. Non-singular terminal sliding mode control of rigid manipulators[J]. Automatica , 2002, 38 (12) : 2159-2167 DOI:10.1016/S0005-1098(02)00147-4 |
[18] | MONDAL S, MAHANTA C. Adaptive integral higher order sliding mode controller for uncertain systems[J]. Journal of Control Theory and Applications , 2013, 11 (1) : 61-68 DOI:10.1007/s11768-013-1180-5 |
[19] | PLESTAN F, SHTESSEL Y, BREGEAULT V, et al. New methodologies for adaptive sliding mode control[J]. International Journal of Control , 2010, 83 (9) : 1907-1919 DOI:10.1080/00207179.2010.501385 |
[20] | MOHAMMADI A, TAVAKOLI M, MARQUEZ H J, et al. Nonlinear disturbance observer design for robotic manipulators[J]. Control Engineering Practice , 2013, 21 (3) : 253-267 DOI:10.1016/j.conengprac.2012.10.008 |
[21] | ZHAO D, ZHU Q, LI N, et al. Synchronized control with neuro-agents for leader—follower based multiple robotic manipulators[J]. Neurocomputing , 2014, 124 : 149-161 DOI:10.1016/j.neucom.2013.07.016 |
[22] | LIU H, ZHANG T. Neural network-based robust finite-time control for robotic manipulators considering actuator dynamics[J]. Robotics and Computer-Integrated Manufacturing , 2013, 29 (2) : 301-308 DOI:10.1016/j.rcim.2012.09.002 |