文章快速检索  
  高级检索
基于干扰观测器的机器人自适应滑模控制
张贝贝, 赵东亚, 赵通     
中国石油大学(华东)化学工程学院, 山东 青岛 266580
摘要: 研究了一种基于干扰观测器的自适应滑模控制算法,并应用到机械臂运动控制当中,实现了机械臂关节运动的精确控制.考虑到机械臂系统存在外界干扰,设计了一种基于非奇异终端滑模的干扰观测器,对外界干扰进行估计并对系统输入进行补偿.结合提出的干扰观测器,设计了一种基于干扰观测器的连续自适应滑模控制方法,克服了系统“抖振”,提高了控制精度.通过李亚普诺夫方法证明了该算法的闭环系统稳定性.最后,将提出的连续滑模控制算法应用到机械臂运动控制当中,通过Matlab仿真表明其在外界干扰存在条件下,具有较高的控制精度和良好的鲁棒性.
关键词: 机械臂     干扰观测器     滑模控制     自适应     李亚普诺夫方法    
Adaptive Sliding Mode Control Based on Disturbance Observer for Manipulator Systems
ZHANG Beibei, ZHAO Dongya, ZHAO Tong     
College of Chemical Engineer, China University of Petroleum, Qingdao 266580, China
Abstract: We propose a novel adaptive sliding mode control algorithm for manipulator systems based on a disturbance observer. This mode control algorithm is successfully used in the motion control of manipulator systems to improve control precision and robustness. Considering external disturbance, we develop a new disturbance observer based on non-singular terminal sliding mode to compensate for control input to enhance precision. Then, we propose a continuous adaptive sliding mode control algorithm with a disturbance observer which can overcome chattering and improve control precision. Closed-loop stability is proved by Lyapunov theory. Matlab simulation results verify that the proposed approach has high precision and strong robustness in the presence of external disturbance and system uncertainty.
Key words: manipulator     disturbance observer     sliding mode control     adaptive     Lyapunov method    

0 引言

20世纪50年代,前苏联学者提出的变结构控制思想,是滑模控制的最初起源[1].滑模控制算法作为变结构控制的一个典型代表,相较于其它传统控制算法具有以下几个优势:

1) 滑模控制对参数扰动和匹配不确定性具有较强的鲁棒性,收敛速度快[2]

2) 相对于其它控制算法,滑模控制器设计比较简单、运算量小、工程实践性更好.

近20年来,随着滑模控制理论研究的不断深入,滑模控制已经在机器人、化工过程控制、船舶动力工程等多个领域取得了十分广泛的应用[3-5].机器人系统作为一种复杂的非线性系统,具有强耦合、非线性等特点,为了使机器人能在保障安全和稳定的前提下精确完成各种操作任务,需要设计高性能控制器.滑模控制能有效地提高机械臂的工作精度,改善鲁棒性[6-8],从而获得较好的控制效果.

滑模主要分为线性滑模和非线性滑模两大类.线性滑模能够使系统渐近收敛到平衡点.如果提高系统的控制高精度,一般需要增大控制增益,这会给系统输入带来较大负担.非线性滑模可以使系统有限时间收敛到平衡点[9-11],鲁棒性更强.但是,在实际的滑模控制设计过程中,如果考虑系统不确定性和外部干扰,采用切换控制虽然能使系统实现稳定,但"抖振"现象会给实际应用带来困难[12];采用非切换控制,无论是线性滑模还是非线性滑模,系统最终只能收敛到一个剩余集中.一般情况下,增大控制增益可以有效缩小剩余集,从而提高控制精度,增强鲁棒性.但是,较大的控制增益会使系统输入增加,"抖振"加剧,甚至导致控制器输出饱和[10].因此在改善"抖振"的同时提高系统的控制精度具有一定的现实意义.

改善"抖振"的方法有很多,当前研究的主要方法有自适应控制方法、边界层方法、连续趋近律方法、神经网络方法、模糊控制、干扰观测器方法等.文[13]提出一种基于特征模型的自适应离散滑模控制,实现柔性部件振动的快速抑制.文[14]提出了一种基于边界层的模糊滑模控制算法,在避免高频"抖振"的同时实现了电机的高精度运行.文[15]针对微电机陀螺仪提出一种全局神经网络滑模控制算法,实现系统的连续控制,改善系统动态品质.文[16]给出一种基于非线性干扰观测器的动态反演控制实现导弹飞行轨迹的精确追踪.文[17]则在理论角度设计一种高阶系统的干扰观测器结构,通过准确估计外部干扰,达到减小抖振和提高控制精度的目的.但是文[16-17]给出的干扰观测器只能实现干扰估计误差渐近收敛到0,在快速响应方面存在局限性.针对以上问题,文[18]设计了一种新型干扰观测器结构,实现干扰估计误差有限时间收敛到0,从而保证系统快速响应,避免"抖振"现象,但其不足在于该干扰观测器仅适用于1阶非线性系统,对2阶系统(例如机器人系统)并不适用.因此,针对上述干扰观测器存在的问题,本文将提出一种适用于2阶系统的新型干扰观测器结构,实现干扰的有限时间估计,并最终应用到机器人滑模控制当中,消除"抖振",实现系统的高精度控制.综上所述,本文的创新点如下:

1) 设计了一种适用于2阶非线性系统的新型干扰观测器结构,实现干扰的有限时间估计,保证系统快速响应的同时,避免"抖振"现象.

2) 根据文[19],设计一种基于干扰观测器的机械臂系统连续自适应滑模控制方法,实现了系统的高精度控制.与文[19]中机器人滑模控制算法相比,如果考虑外界扰动,本方法能显著减小系统的控制输入,克服"抖振"现象,改善了系统的动态性能.

1 问题描述

针对典型的n轴机械臂系统,其动力学方程为

(1)

其中,q=[q1q2,…,qn]T分别代表机械臂系统关节角位移和角速度矢量;M(q)∈Rn×n为正定对称惯性矩阵;∈Rn×n代表离心力和柯氏力向量;G(q)∈Rn代表重力项;u∈Rn代表机械臂关节力矩矢量;d∈Rn代表外界干扰,‖d‖≤DD∈R+且未知.

,将方程(1)写为状态空间方程的形式:

(2)

其中:D(tx)=M-1(x1)dB(x)=M-1(x1),F(x)=-M-1(x1)[C(x1x2)x2+G(x1)].

假设1  假设∃D > 0,使满足.

假设2  假设方程(2)状态变量都是可测的.

根据假设2,设机械臂关节角位移和角速度的期望信号分别为qd=[q1dq2d,…,qnd]T.定义机械臂系统的位置误差及其导数为

(3)

本文将根据机械臂状态空间方程(2)及系统误差(3)完成干扰观测器和机械臂系统的控制律设计.

2 干扰观测器设计

为简化设计和方便分析,定义符号:

引理1  假设存在实数m和实数a1a2,…,an,且0 < μ < 2,ai > 0,那么会有:

(4)

外界干扰在机械臂系统中难以避免,为减少干扰对控制器性能的影响,本文设计了一种新型干扰观测器结构,实现干扰的有限时间估计.干扰观测器的结构为

(5a)
(5b)

根据式(5a)设计的干扰观测器微分方程为

(6)

其中,κ2=[1/Δ1,…,1/Δn]T,Δi=c+σ*i(0)eΩi(t) × sgn(x2i-z2i);Ω(t)=[Ω1(t),…,Ωn(t)]Tc > 0;Λ1i > 0,Λ2i > 0;λ1 > 0,λ2 > 0;0 < γ1 < 1,γ2>1;D > 0,η > 0;Λ1=diag{Λ1 1,…,Λ1 n};Λ2=diag{Λ2 1,…,Λ2 n};θ=p/qp < qpq是正奇数;z2=[z21z22,…,z2n]T;0 < δ < 1,α > 0;是干扰的估计值.定义干扰估计误差为

(7)

定义当x2i=z2i时,Ωi(t)的导数为根据式(5a)可以得到:

(8)

其中,κ=[Δ1,…,Δn]Tκ3=[σ*1(0)eΩ1(t)sgn(x21-z21),…,σ*n(0)eΩ1(t)sgn(x2n-z2n)]T,由式(8)可得中间变量为

(9)

进一步整理式(8)可得σ0的2阶导数表达式

(10)

其中,κ4=[,…,· sgn(x2n-z2n)]T.

将式(9)和式(10)代入到滑模(5a)中,整理可得:

(11)

其中,·sgn(x2n-z2n)/Δn2]T.

为加快系统的收敛速率使其在有限时间内收敛到滑模面σ1=0,采用文[20]给出的双次幂趋近律:

(12)

将式(6)和式(12)代入式(11)整理得:

(13)

定理1  如果滑模的结构如式(5a)所示,干扰观测器微分方程如式(6)所示,那么观测误差将会在有限时间内收敛到0,收敛时间T

(14a)

其中,

(14b)
(14c)

Ψ=λ12(γ1+1)/2ω=δεθμmin(Λ2)/μmin(Λ1),μmin(Λ1)和μmin(Λ2)分别代表Λ1Λ2的最小特征值.

证明  选李亚普诺夫函数为

(15)

V1进行求导并代入式(13),可以得到:

(16)

考虑引理1并整理得:

(17)

Ψ=λ12(γ1+1)/2,进一步可以得到:

(18)

解得收敛时间T1

(19)

由收敛时间(19)可得,系统会在有限时间内收敛到滑模面σ1=0.到达滑模面之后可以得到:

(20)

证明  变量σ0会在滑模面σ1=0上有限时间收敛到0,选择李亚普诺夫函数:

(21)

V2求导并代入式(20)可得:

(22)

由式(5b)可得不等式:

(23)

当|σ0i|=0时,;当|σ0i|≠0时,根据引理1:

(24)

解得收敛时间T2

(25)

其中ωμmin(Λ1)的定义同式(14).由式(8)可得,当且仅当σ0→0,时,系统,干扰估计误差会在有限时间内收敛到0,证毕.

3 基于干扰观测器的自适应连续滑模控制器设计

上节设计的干扰观测器能够在有限时间精确地估计系统干扰,本节将根据给出的干扰观测器,设计一种基于干扰观测器的自适应连续滑模控制方法以减小"抖振",改善鲁棒性,提高控制精度.

首先,结合式(3)定义的系统误差,定义一个线性滑模面:

(26)

其中,C=diag{C1,…,Cn},误差变量在滑模面上能实现渐近收敛到0.考虑文[19]给出的一种变增益的不连续趋近律:

(27)

其中,υ > 0,K > 0.

与传统的等速趋近律相比,趋近律(27)有效地缩短了收敛时间,减小抖振,但是其切换控制的本质决定了系统在收敛过程中"抖振"现象无法消除.本文在文[19]的基础上,采用自适应变增益的方法,设计一种自适应幂指数趋近律,从本质上避免"抖振",加快收敛时间.本文设计的滑模趋近律为

(28)

自适应律设计为

(29)

其中,K1 > 0,K2 > 0,γD > 0,0 < ψ < 1,N(S)、υ的定义同式(27).

同趋近律(27)相比,新提出的自适应趋近律有效避免了不连续切换造成的"抖振"现象.自适应方法的引入使系统不断修正自身参数以适应系统状态变化,改善了系统的动态性能,提高控制精度.同时,自适应变增益会使系统在趋近过程中自发的调节收敛速度,减小控制输入.

定理2  如果滑模面设计为式(26),趋近律设计为式(28),结合滑模干扰观测器(5),基于干扰观测器的机械臂系统自适应连续滑模控制为

(30)

那么,滑模S和系统误差ξ能够实现一致最终有界.

证明  为了证明整个系统的闭环稳定性,选择李亚普诺夫候选函数:

(31)

其中,.

V3求导后得到:

(32)

考虑滑模面(26)和设计的控制律(30),可得:

(33)

根据设计的干扰观测器可知,干扰估计误差能在有限时间内收敛到0,所以,可以给出假设3:

假设3  假设干扰观测器的估计误差是有界的,且满足关系式:

(34)

其中,0 < γ < 1,K2N(S)定义同(28).由引理2可知.将式(33)和式(29)代入式(32)整理得:

(35)

根据不等式(35)得,滑模S和系统误差ξ一致最终有界,证毕.

4 仿真分析

考虑2轴平面机械臂系统,动力学方程为

采用本文提出的控制律(31),控制参数为:m1=0. 5 kg,m2=1. 5 kg,r1=1 kg,r2=0. 5 kg,g=9. 8 N/s2j1=j2=5 kg·m,C=diag{3,3},K1=1,υ=1,=0.5,ψ=3/5,c=2,p=3,q=5,α=1,Λ1=Λ2=5,ε=0. 001,λ1=λ2=6,γ1=3/5,γ2=5/3,k=3,δ=0. 5.机器人两关节的期望轨迹分别为:q1d=1. 25-1. 4e-t+0. 35e-4tq2d=1. 25+e-t-0.25e-4t. d=[6cos(πt),sin(πt)]T,机械臂关节的初始位置为:q1(0)=1. 0,q2(0)=1. 5,.自适应参数初始值为,仿真如图 1~图 3所示.

图 1 基于连续滑模控制的机械臂系统状态响应曲线 Figure 1 The state response curves of manipulator systems based on the continuous sliding mode control
图 2 干扰观测器干扰逼近曲线 Figure 2 Approach curves of disturbance of disturbance observer
图 3 自适应参数时间响应曲线 Figure 3 Time response curve of adaptive parameter

图 1(a)图 1(b)中可得,采用基于干扰观测器的自适应连续滑模控制,机械臂位置误差能够渐近收敛到平衡点.具体而言,从图 1(c)可以看出,系统首先在有限时间内收敛到线性滑模面S1=0和S2=0,收敛时间分别为t1=1. 1 st2=0. 9 s.到达滑模面后,系统状态将沿着滑模面渐近收敛到0.由于控制律(30)为连续滑模控制,整个收敛过程中,系统没有发生"抖振"现象,机械臂控制输入的连续性也可以在图 1(d)得到验证.

综合图 1(a)~图 1(c)图 2可得,虽然外界存在较大干扰,但是系统误差和滑模并没有发生较大波动,控制精度较高,这得益于干扰观测器能够在有限时间内准确地估计出外在干扰,对系统输入形成补偿,减小了干扰对系统影响,提高了控制精度. 图 3给出的是自适应参数随时间的变化曲线,自适应方法能不断修正自身参数以适应系统状态变化,提高了控制精度,改善控制效果.

为了方便比较,本文引入文[19]给出的机械臂系统滑模切换控制:

(36)

图 3中可得自适应参数的稳定估计值为,运用控制律(36),仿真参数设置如下:K1=1,= 2. 240 6,C=diag{3,3},q1d=1. 25-1. 4e-t+ 0. 35e-4tq2d=1. 25+e-t-0. 25e-4t,初始位置q1(0)=1. 0,q2(0)=1. 5,,干扰项d=[6cos(πt),sin(πt)]T.仿真结果如图 4图 5所示.

图 4 基于连续和不连续滑模控制的机械臂状态响应曲线 Figure 4 The state response curves of manipulator systems based on continuous and discontinuous sliding mode control
图 5 基于不连续滑模控制的机械臂输入时间响应曲线 Figure 5 Time response curves of control inputs of manipulator systems based on discontinuous sliding mode control

图 4给出的是文[19]和本文方法的系统状态对比结果.首先,由图 4可以看出,基于干扰观测器的自适应连续滑模控制方法大大提高了机械臂系统的控制精度,干扰观测器的补偿作用能大大减小外界干扰对系统的影响,结合连续控制,误差变量和滑模的"抖振"现象被完全克服,系统鲁棒性得到显著改善.同时,由图 1(d)图 5可以看出,与传统的不连续控制相比,自适应方法虽然增加了系统在趋近阶段的收敛时间,但是,自适应参数的变化能避免机械臂伺服电机在启动阶段启动力矩过大的问题,减小控制输入,改善了系统动态性能.综上所述,本文提出的基于干扰观测器的机械臂自适应连续滑模控制方法取得的效果是令人满意的.

5 结论

本文针对机械臂系统高精度控制,研究了一类存在外部干扰条件下的机械臂滑模控制方法.为了改善机械臂系统的鲁棒性,避免"抖振",提高控制精度.本文设计了一种基于干扰观测器系统的自适应连续滑模控制方法.其中,干扰观测器能够有限时间精确估计外部干扰,并对系统输入进行补偿,提高控制精度,避免"抖振".自适应滑模控制方法使控制参数能够自动的随系统状态变化而变化,改善了系统的动态性能,减小控制输入.最终,通过仿真表明,该方法能有效的克服系统外在干扰,大幅提高系统的控制精度,消除"抖振现象",改善系统的动态性能.

参考文献
[1] 梅红, 王勇. 快速收敛的机器人滑模变结构控制[J]. 信息与控制, 2009, 38(5): 552–557.
Mei H, Wang Y. Fast convergent sliding mode variable structure control of robot[J]. Information and Control, 2009, 38(5): 552–557.
[2] 黄国勇. 基于神经网络干扰观测器的Terminal滑模控制[J]. 吉林大学学报:工学版, 2011, 41(6): 1726–1730.
Huang G Y. Terminal sliding mode control based on neural network disturbance observer[J]. Journal of Jilin University:Engineering and Technology Edition, 2011, 41(6): 1726–1730.
[3] Islam S, Liu X P. Robust sliding mode control for robot manipulators[J]. IEEE Transactions on Industrial Electronics, 2011, 58(6): 2444–2453. DOI:10.1109/TIE.2010.2062472
[4] Zhao D, Zhu Q, Dubbeldam J. Terminal sliding mode control for continuous stirred tank reactor[J]. Chemical Engineering Research and Design, 2015, 94: 266–274. DOI:10.1016/j.cherd.2014.08.005
[5] Perera L P, Soares C G. Pre-filtered sliding mode control for nonlinear ship steering associated with disturbances[J]. Ocean Engineering, 2012, 51: 49–62. DOI:10.1016/j.oceaneng.2012.04.014
[6] Van M, Franciosa P, Ceglarek D. Fault diagnosis and fault-tolerant control of uncertain robot manipulators using high-order sliding mode[J]. Mathematical Problems in Engineering, 2016, 2016: ID 7926280.
[7] 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
[8] Khireddine M S, Boutarfa A. Fault tolerant control on robotic manipulator using sliding mode observers[C]//International Conference on Computer Applications Technology. Piscataway, NJ, USA: IEEE, 2013: 1-6.
[9] Levant A. Principles of 2-sliding mode design[J]. Automatica, 2007, 43(4): 576–586. DOI:10.1016/j.automatica.2006.10.008
[10] Kao Y G, Wang C H, Xie J, et al. Hsliding mode control for uncertain neutral-type stochastic systems with Markovian jumping parameters[J]. Information Sciences, 2015, 314: 200–211. DOI:10.1016/j.ins.2015.03.047
[11] Zhang X, Su H, Lu R. Second-order integral sliding mode control for uncertain systems with control input time delay based on singular perturbation approach[J]. IEEE Transactions on Automatic Control, 2015, 60(11): 3095–3100. DOI:10.1109/TAC.2015.2411991
[12] 靳宝全, 熊诗波, 程珩. 电液位置伺服系统的变速趋近律滑模控制抖振抑制[J]. 机械工程学报, 2013, 49(10): 163–169.
Jin B Q, Xiong S B, Cheng H. Chattering inhibition of variable rate reaching law sliding mode control for electro-hydraulic position servo system[J]. Chinese Journal of Mechanical Engineering, 2013, 49(10): 163–169.
[13] 钟华, 潘金文, 王永. 一种基于特征模型的自适应离散滑模控制[J]. 信息与控制, 2015, 44(1): 56–61.
Zhong H, Pan J W, Wang Y. Characteristic model-based adaptive discrete-time sliding mode control[J]. Information and Control, 2015, 44(1): 56–61.
[14] Saghafinia A, Ping H W, Uddin M N. Fuzzy sliding mode control based on boundary layer theory for chattering-free and robust induction motor drive[J]. The International Journal of Advanced Manufacturing Technology, 2014, 71(1/2/3/4): 57–68.
[15] Chu Y, Fei J. Adaptive global sliding mode control for MEMS gyroscope using RBF neural network[J]. Mathematical Problems in Engineering, 2015, 2015(1): 1–9.
[16] Chen W H. Nonlinear disturbance observer-enhanced dynamic inversion control of missiles[J]. Journal of Guidance, Control, and Dynamics, 2003, 26(1): 161–166. DOI:10.2514/2.5027
[17] Yang J, Li S, Yu X. Sliding-mode control for systems with mismatched uncertainties via a disturbance observer[J]. IEEE Transactions on Industrial Electronics, 2013, 60(1): 3988–3993.
[18] Chen M, Yu J. Disturbance observer-based adaptive sliding mode control for near-space vehicles[J]. Nonlinear Dynamics, 2015, 82(4): 1671–1682. DOI:10.1007/s11071-015-2268-x
[19] Fallaha C J, Saad M, Kanaan H Y, et al. Sliding-mode robot control with exponential reaching law[J]. IEEE Transactions on Industrial Electronics, 2011, 58(2): 600–610. DOI:10.1109/TIE.2010.2045995
[20] 张合新, 范金锁, 孟飞, 等. 一种新型滑模控制双幂次趋近律[J]. 控制与决策, 2013, 28(2): 289–293.
Zhang H X, Fan J S, Meng F, et al. A new double power reaching law for sliding mode control[J]. Control and Decision, 2013, 28(2): 289–293.
http://dx.doi.org/10.13976/j.cnki.xk.2018.0184
中国科学院主管,中国科学院沈阳自动化研究所、中国自动化学会共同主办。
0

文章信息

张贝贝, 赵东亚, 赵通
ZHANG Beibei, ZHAO Dongya, ZHAO Tong
基于干扰观测器的机器人自适应滑模控制
Adaptive Sliding Mode Control Based on Disturbance Observer for Manipulator Systems
信息与控制, 2018, 47(2): 184-190, 199.
Information and Control, 2018, 47(2): 184-190, 199.
http://dx.doi.org/10.13976/j.cnki.xk.2018.0184

文章历史

收稿/录用/修回: 2016-12-20/2017-03-16/2017-03-23

工作空间