优胜从选择开始,我们是您最好的选择!—— 中州期刊联盟(新乡市博翰文化传媒有限公司)
0373-5939925
2851259250@qq.com
我要检测 我要投稿 合法期刊查询
您的位置:网站首页 > 优秀论文 > 其他论文 > 正文

考虑输出约束的冗余驱动绳索并联机器人预设性能控制

作者:陈正升 程玉虎 王雪松来源:《自动化学报》日期:2022-08-24人气:1526

并联机器人具有高精度、高刚度及大负载自重比等优点, 已大量应用于高速搬运、运动模拟与电子制造等行业. 绳索驱动并联机器人是传统刚性并联机器人的延伸, 它采用绳索取代传统刚性并联机器人的刚性杆件, 具有工作空间大、杆件惯性低、可扩展性强等优点[1].

然而, 由于绳索具有柔性仅能传递拉力, 因此必须保证绳索运行过程中始终处于拉伸状态, 目前通用的做法是增加冗余支链形成冗余驱动绳索并联机器人(Redundantly-actuated cable driving parallel robots, RCDPRs), 通过控制冗余系统内力实现各杆件拉伸进而保证机器人正常运行. 由于制造与安装误差的存在, 机器人杆件长度、驱动装置与负载安装位置、驱动系统与负载等参数都存在误差, 这将产生模型不确定性, 同时由于外部扰动的存在, 系统扰动项不可忽略. 开展冗余驱动绳索并联机器人高速高精度轨迹跟踪控制受到了广泛关注, 这也是目前的研究难点与热点. 动力学前馈控制[2]、神经网络控制[3]、鲁棒H控制[4]、自适应控制[5]以及滑模控制[6-7]等已被应用于绳索驱动并联机器人的轨迹跟踪控制中.

由于滑模控制对参数不确定及外部扰动具有较强的鲁棒性及扰动抑制能力, 因此被广泛应用于线性与非线性系统控制中. 为提高传统线性滑模控制的收敛速度, 文献[8-9]在滑模面设计时采用非线性超平面代替传统滑模面中的线性超平面, 提出了终端滑模控制 (Terminal sliding mode control, TSMC)与快速终端滑模控制 (Fast terminal sliding mode control, FTSMC), 此类控制方法不仅具有有限时间收敛特性, 同时降低了控制增益, 然而跟踪误差在零附近时TSMC与FTSMC的控制输入将会出现奇异问题; 文献[10-13]通过设计滑模面中分数次幂项提出了非奇异终端滑模控制 (Nonsingular terminal sliding mode control, NTSMC)与非奇异快速终端滑模控制 (Nonsingular fast terminal sliding mode control, NFTSMC), 解决了TSMC与FTSMC中的奇异问题; 针对文献[12-13]中由于误差高阶项的非线性系数使得控制算法设计复杂的问题, 文献[14]提出在分段点具有两阶连续的NFTSMC算法. 然而, 采用上述算法取得的跟踪精度依赖于滑模面系数的选择, 较大的系数将会取得良好的跟踪精度, 但同时也需要更大的驱动力矩, 因此, 研究NFTSMC中滑模面系数的选择方法使得其可以依据跟踪误差数值进行调整具有重要意义.

符号函数的使用及其增益的过估计产生的抖振现象是滑模控制面临的另外一个关键问题. 为了降低或消除抖振问题, 国内外学者提出了边界层滑模、高阶滑模、自适应滑模与基于观测器的滑模控制等. 自适应滑模控制采用模糊规则、神经网络、多项式对扰动项进行逼近, 或对符号函数的增益项进行自适应更新, 并在算法稳定性分析时确定自适应项更新率, 进而保证算法稳定性[15-16]. 自适应方法可以获得较小的稳态跟踪误差, 但通常需要较大的增益才能取得理想效果, 同时需要较大驱动力矩. 基于观测器的滑模控制是解决抖振问题的另外一种有效方法, 该方法采用观测器对扰动项进行估计, 国内外研究学者分别采用了扰动观测器[17-18]、扩张观测器[19]、时延观测器[20]、滑模观测器[21]对滑模控制的扰动项进行估计, 但扰动估计精度依赖于观测器参数的选择. 模型不确定与扰动观测器 (Uncertainty and disturbance estimator, UDE)采用滤波器对扰动项进行估计, 目前已应用于机械系统控制的扰动估计中[22-24], 且与时延观测器相比, UDE可以取得更好的扰动估计效果[25]. 然而, UDE等扰动观测器通常被视为低通滤波器, 无法对高频扰动进行有效估计, 这将产生稳态跟踪误差, 且观测精度对参数选取较敏感.

上述研究仅考虑了稳态误差, 没有考虑系统整个运行阶段的输出约束. 现有针对输出约束的研究主要采用障碍Lyapunov函数与预设性能函数进行实现, 由于基于障碍Lyapunov函数的方法存在描述输出性能的参数少及内在奇异性问题, 使得其应用受到一定限制[26-27]; 基于预设性能的方法通过构建非线性函数将约束形式的跟踪误差转化为无约束形式变量, 同时可以通过设计指数衰减函数实现给定时间的输出约束[28-29], 该方法已被广泛应用于机器人控制中. 然而现有基于预设性能的输出约束控制主要采用指数衰减函数, 无法获得达到预定性能的具体时间, 同时由于机器人中电机与减速机输出能力不对称等原因, 研究非对称给定时间输出约束具有重要意义. 为实现冗余驱动绳索并联机器人的高精度控制并解决上述方法存在的问题, 本文将开展以下研究: 1) 设计给定时间衰减函数与非线性变换函数, 并将考虑预设性能的跟踪误差转换为无约束变量, 实现非对称给定时间输出约束; 2) 提出基于精度驱动且在分段点处三阶连续的非奇异快速终端滑模面进行控制算法设计, 实现有限时间控制; 3) 结合扰动观测器与自适应控制优点, 在预设性能控制中采用UDE进行扰动估计, 并通过自适应方法对扰动估计误差进行补偿, 同时开展仿真研究, 验证本文算法的有效性.

动力学模型是开展控制算法研究的基础, 本节以图1所示具有m个自由度的冗余驱动绳索并联机器人为对象分别开展运动学与动力学建模, 该机器人由基座、动平台和n条通过绳索连接的分支组成. 坐标系{O}{P}OP为原点, 分别固连到基座与动平台上, 其中i=1,,n; 绳索与动平台及基座的连接点为AiBi, 其在动平台与基座坐标系下的位置矢量分别表示为aibipli表示在基座坐标系下动平台和绳索的位置矢量; 动平台中心点P的位姿即系统输出η=[pTo]T, 由位置矢量p=[xyz]T及姿态角度o=[ϕθφ]T组成, 其中欧拉角ϕθφ分别为关于Z轴、Y轴和X轴的转动角度, 相应的旋转矩阵为[30]:

图 1  冗余驱动绳索并联机器人结构原理图
Fig. 1  Structural schematic diagram of the RCDPR


(1)

其中, Rx(φ)Ry(θ)Rz(ϕ)分别表示沿X轴、Y轴与Z轴的旋转变换矩阵.

根据图1, 绳索i的运动方程及长度可表示为[31]:


(2)

其中, li为第i根绳索长度, di=li/li为描述绳索方向的单位向量, aibi为常向量. 随着动平台位姿变量η的改变, 动平台位置p与描述姿态变化的旋转矩阵Rp将发生改变, 进而使得绳索i的长度li随之改变.

将式(2)第一部分对时间求一阶导数, 并对方程两边点乘di可得:


(3)

其中, l˙i为绳索i的长度变化率, p˙ω分别为动平台平移速度与角速度, diT为单位向量di的转置. 根据混合积的运算关系有diT(ω×Rpai)=(Rpai×di)Tω, 为便于对各绳索运动进行统一描述, 根据式(3), 建立各绳索与动平台的运动关系为:


(4)

其中, l˙表示由各绳索长度变化率组成的速度向量, o˙o的导数, J为描述动平台与绳索速度映射的雅可比矩阵, ω=So˙为基座坐标系下动平台角速度. 映射矩阵S及单位矩阵S可表示为[30]:


(5)

其中, I303分别为3×3的单位对角阵与零矩阵. 以上述运动学模型为基础, 根据Newton-Euler方程, 动平台的动力学方程可表示为[30]:


(6)

其中, mp为动平台质量, Ip=RpTIpRp为动平台关于基座坐标系的惯量矩阵, Ip为动平台关于固连坐标系的惯量矩阵, JT为矩阵J的转置, F为绳索拉力, 03×1为 3×1的零矩阵. 将式(4)中运动关系[p˙;ω]=S[p˙;o˙]代入式(6), 同时为保证惯性矩阵对称性, 将式(6)两边同时乘以S可得:


(7)

根据牛顿运动定律, 电机运动方程为:


(8)

其中, Ibr为电机−滑轮组件的转动惯量及滑轮半径, q¨=l¨/r为电机运转的角加速度. 将式(4)中第一个方程对时间求导, 将其代入式(8)可得:


(9)

将式(9)两边同时乘以STJT/r, 并与式(7)相加, 可得到绳索驱动并联机器人一般形式的动力学方程为:


(10)

其中, M1=[mpI303;03STRpTIpRpS]M2=IbSTJTJS/r2M=M1+M2f1=[Gp;ST(So˙×RpTIpRpS+RpTIpRpS˙)o˙], f2=IbSTJT(JS˙η˙+J˙Sη˙)/r2f=f1+f2B=SJT/r为电机参数传输矩阵, d=ΔMη¨+Δf+de为扰动项, de为外部扰动, ΔMη¨+Δf为模型不确定项, ΔMΔf分别为Mf的不确定部分.

设置绳索组成的支链数n大于机器人自由度m, 因此可以在保证机器人正常运行的情况下控制绳索内力保证其拉伸状态. 根据式(7), 绳索拉力可表示为:


(11)

其中, W+=WT(WWT)1为矩阵W=STJT的 Moore-Penrose伪逆矩阵, N为矩阵W的零空间矩阵; λ为(n − m)维的任意向量. 方程(11)为绳索拉力的所有可能解, 而对于给定位姿, 驱动力矩τ应该是确定的而且满足节能要求. 因此, 本文将绳索拉力的2范数作为优化目标, 其2范数可表示为:


(12)

其中, Fnom=M1η¨+f1. 由于优化变量λ仅出现在λTλ中, 因此为保证绳索处于拉伸状态及节能要求, 可构建如下优化问题:


(13)

其中, Fδ为设定的最小正拉力, 上式可采用二次规划方法进行求解.

假设 1. 假设扰动项d有界且一阶可导, 其导数d˙=[d˙1,,d˙n]T 有界, 并满足 |d˙i|d˙id˙=[d˙1,,d˙n]T.

对于冗余驱动绳索并联机器人, 假设其末端位置η与速度η˙是可测的, 本文开展的控制问题可描述为: 对于动力学模型(10)与绳索拉力优化模型(13), ηηd分别为系统输出及其期望跟踪轨迹, 考虑系统扰动d设计驱动力矩τ, 使得η的跟踪误差始终在预定的约束范围内, 并保证所有的绳索拉力不小于Fδ及驱动力矩最小.

引理 1[32]. 对于任意给定的正数η, 以下不等式成立:


(14)

其中, tanh()为双曲正切函数, γ为正常数.

引理 2[33]. 对于连续正定函数V(t), 当t>0时不等式V˙(t)a0Vα(t)+b0成立, 其中a0b0α均为正值, 并满足0<α<1, 则存在0<θ0<1, 使得V(t)在有限时间Tr收敛到V0, 且V0Tr的上界分别为:


(15)

UDE方法根据系统模型、控制律及滤波器得到扰动表达式[34-35], 可表示为:


(16)

其中, L1()为Laplace逆变换, 表示卷积运算, Gf表示滤波器gf的频域表达式. 文中Gf为一阶滤波器, 可表示为:


(17)

其中, s为Laplace算子, T为时间常数, 将式(16)代入式(17)可得:


(18)

定义d~=dd^=[d~1,,d~n]T为扰动估计误差, 由式(18)可得到扰动估计误差为:


(19)

根据式(19)可得:


(20)

其中, e为自然常数, A=Im/ImTTb=Im.

由于时间常数T是正值, A为Hurwitz矩阵. 根据假设1与式(20), 存在正向量d~max=[d~1max,,d~nmax]T, 使得|d~i|d~imax成立, 因此扰动估计误差是有界的.

注 1. 对于冗余驱动绳索并联机器人系统, 模型不确定项ΔMη¨+Δf满足假设1. 外部扰动项de为机器人与环境之间的交互力, 由于机电系统本身具有一定柔性, de的导数可能在极短时间内不存在, 其仅对瞬态的跟踪误差产生影响, 不改变系统收敛特性.

根据动力学模型, 定义跟踪误差为:


(21)

其中, ηd为期望的位置. 为实现输出约束, 对跟踪误差定义如下非对称约束:


(22)

其中, ε1i>0ε2i>0为常数, 记ε1=[ε11,,ε1m]Tε2=[ε21,,ε2m]T, 且ε1iε2iμi(t)为给定时间衰减函数. 与现有预设性能控制中指数衰减函数不同, 为实现给定时间输出约束, 定义如下给定时间衰减函数:


(23)

其中, μ=[μ1,,μm]Tekt为指数项, μi0>0μi(t)的初始值, 终止值满足μi=limtμi(t)>0, 分别记为μ0=[μ10,,μm0]Tμ=[μ1,,μm]T, 收敛率k为常数, Te为给定时间常数.

式(22)为约束形式的跟踪误差e, 为便于算法设计, 本文采用饱和函数将其转化为无约束形式变量z=[z1,,zm]T, 可表示为:


(24)

其中, ςi(zi)为非线性变换函数, 可表示为[36]:


(25)

其中, vi=ln(μ2i/μ2iμ1iμ1i)/ln(μ2i/μ2iμ1iμ1i)22ςi(zi)为递增函数, 具有以下性质:

1) ςi(0)=0; 2) limzi+ςi(zi)=βi3)limziςi(zi)=αi

转换后的跟踪误差zi可表示为:


(26)

根据式(26), 跟踪误差zi的速度与加速度为:


(27)

diag{}表示对角线元素为实向量·的对角阵, χ=diag{σ1,,σm}Λ = diag{μ1,,μm}均为对角阵, 且σi=(ε2i+ε1i)/(2(ε2iμi(t)ei)(ε1iμi(t)+ei)).

为保证跟踪误差有限时间收敛, 本文提出精度驱动的非奇异快速终端滑模面:


(28)

其中, s=[s1,,sm]TK1=diag{[k11,,k1m]}K2=diag{[k21,,k2m]}为正常数对角矩阵, ρ1ρ2分别为:


(29)

其中, s¯i=z˙+(1+β4tanh(β5|zi|))(k1izi+k2isigα1(zi))α1α2α3满足0<α1<1<α2<α3<2Δ1i为设定的跟踪误差值, β4β5为用户给定的正常数. β1iβ3i可根据滑模面及其一阶与二阶导数的连续性计算得到, 可表示为:


注 2. 式(29)中ρ1(z)为精度驱动的时变向量函数, 用于提高滑模阶段跟踪误差z的收敛速度, 同时可以根据|z|的数值调整自身大小, 进而避免了跟踪误差收敛到稳定状态时过大的输入力矩; ρ2(z)用于避免滑模面出现奇异, 并保证其有限时间收敛特性.

引理 3. 根据式(28)所示滑模面, 构造如下系统:


(30)

其中, δ0为有界时变扰动. 则z是有限时间收敛的, 其收敛域为:


证明. 考虑Lyapunov函数V1=zTz/zTz22, 对V1求一阶导数可得:


(31)

由式(29), 当ρ2i(zi)=sigα1(zi)时, V˙1可表示为:


(32)

根据引理1, 当|zi||δ0i|/|δ0i|k1ik1i时, 式(32)满足V˙12i=1nρ1ik2izi1+α1, 位置误差zi是有限时间收敛的, 其收敛上界为Ω1i={zi||zi|max{|zi||δ0i|/k1i,Δ1i}}, 收敛时间Tr1可表示为:


(33)

其中, 0<θ1<1. 当ρ2i(zi)=β1izi+β2isgnα2(zi)+ β3isgnα3(zi)时, V˙1可表示为:


(34)

根据式(34), 当|zi|>|δ0i|/|δ0i|(k1i+β1ik2i)(k1i+β1ik2i)时, 可得V˙1<0, 位置跟踪误差zi有限时间收敛. 综上所述, 位置跟踪误差zi的收敛区域为:


(35)

根据式(28), 滑模面的导数可表示为:


(36)

根据上式可定义控制律为:


(37)

其中, τeq为根据理想模型计算的控制律, τes为扰动估计项, τdi为鲁棒控制项. 根据机器人模型(10)、跟踪误差zi的速度(27)、滑模面(28)及其导数(36), τeq可表示为:


(38)

扰动估计项可表示为:


(39)

鲁棒控制项可表示为:


(40)

其中, K3=diag{k31,,k3m} 与K4=diag{k41,,k4m}均为正常数对角阵, 且对角线上元素均为正. 将式(37) ~ 式(40)代入式(36)可得:


(41)

注 3. 定义ζ=[ζ1,,ζm]T=|M1d~|, 根据假设1及式(20), 扰动观测误差d~及其导数d~˙均有界, 对于有界输入轨迹ηd及其导数η˙d, 对称矩阵M有界. 因此, 存在有界正向量ξ=[ξ1,,ξm]T, 使得 ζiξi成立.

为对扰动观测误差进行补偿, 选择K4tanh(s/sεε)为针对扰动估计误差的鲁棒控制项, 并采用自适应方法对该项系数K4 = diag{k^4+γ0}进行估计, γ0为正常数. 自适应项更新率为:


(42)

其中, λ1λ2为正常数. 根据式(16)与式(10), 扰动估计值d^可表示为:


(43)

将式(37)代入式(43), 并结合式(38) ~ 式(40)可得到扰动估计值d^为:


(44)

定理 1. 考虑系统模型(10)、扰动估计值(44)、控制律(38) ~ (40), 则滑模变量s与跟踪误差zz˙是有限时间收敛的.

证明. 该定理的证明分为2个步骤, 步骤1证明滑模面具有有限时间收敛特性, 步骤2分析位置跟踪误差z与速度跟踪误差z˙的收敛特性与收敛区域.

步骤 1. 为证明滑模面的收敛特性, 构造如下Lyapunov函数:


(45)

其中, ξ~=ξk^4为自适应项估计误差. 对式(45)求导可得:


(46)

根据引理1, 并将式(41)代入式(46), 可得:


(47)

将自适应更新率(42)代入式(47)可得:


(48)

由杨氏不等式有ξ~Tk^4=ξ~T(ξξ~) ξTξ/2ξ~Tξ~/2, 将其代入式(48)可得:


(49)

其中, K2u=2γ0χΛK3u = 2χΛK3σ0=λ1/λ1λ2λ2 (ξTξ/2+(ξTξ/2)1/2)σ1=min{λminK2u,λ1/λ1λ2λ2}λmin为矩阵“·”的最小特征值. 由引理2可知, 存在0<θ1<1si在有限时间Tr1内收敛至某一区域, 收敛域的上界为:


(50)

其中, σ0i=λ1ξiTξi/λ1ξiTξi(2λ2)(2λ2)+λ1/λ1λ2λ2(ξ~iTξ~i/ξ~iTξ~i22)1/2.

步骤 2. 根据式(50), 当满足|si|δ2i时, 滑模面si具有有限时间收敛特性. 根据引理3, zi的有限时间收敛区域为Ω1i={zi||zi|max{|δ0i|/(k1i+β3ik2i),Δ1i}}. □

为验证控制算法有效性, 本文以图2所示的具有7个支链的冗余驱动绳索并联机器人为控制对象进行算法仿真, 机器人运动学参数与惯性参数如表1表2, 各部件的惯性张量在其质心处的固连坐标系下测量.

图 2  带有7个驱动绳索的RCDPR
Fig. 2  The RCDPR with 7 driving cables

表 1  RCDPR运动学参数(mm)
Table 1  Kinematic parameters of the RCDPR (mm)
参数数值参数数值
b1[0, 0, 1000]a1[−150, −100, 50]
b2[100, 0, 1000]a2[150, −100, 50]
b3[1000, 1000, 1000]a3[150, 100, 50]
b4[0, 1000, 1000]a4[−150, 100, 50]
b5[500, 0, 0]a5[0, −100, −50]
b6[1000, 1000, 0]a6[150, 100, −50]
b7[0, 1000, 0]a7[−150, 100, 50]
r20


表 2  RCDPR惯性参数
Table 2  Inertial parameters of the RCDPR
参数描述数值
mp动平台质量1.67 kg
Ip动平台转动惯量矩阵diag{2.78×104, 5.56×104, 7.26×104} kg·mm2
Ib滑轮转动惯量1.2×10kg·mm2

为检验本文提出的预设性能有限时间控制算法的有效性, 将分别进行以下仿真: 1)本文算法 (Prescribed performance sliding mode control, PPSMC); 2)基于时延估计的连续非奇异快速终端滑模控制 (Time delay estimator based nonsingular fast terminal sliding mode control, TDENFTSMC)[14]; 3)基于自适应超螺旋[37]与UDE的非奇异快速终端滑模控制 (Adaptive super-twisting combined UDE based sliding mode control, ASTUDESMC); 4)基于UDE的滑模控制(UDE based sliding mode control, UDESMC)[38]. 在仿真中设置扰动d=0.2Mq¨+f+104(sin5t+sin10t)×16×1; 初始位姿为: x0=459.95mmy0=699.95mmz0=500.05mmθ0=0.001radϕ0=0.001radφ0=0.001rad; 选取函数quadprog对式(13)所示优化问题求解, 并设置最小拉力Fδ=20N; 各控制器参数如表3. 机器人期望运行轨迹为:

表 3  各控制器参数
Table 3  Parameters of all controllers
控制器参数
PPSMCK1K2α1α2α3, Δ11, Δ12, Δ13, Δ14, Δ15, Δ16β4β5K3γ0T, λ1, λ2Teε1iε2iμ0μk100I6, 50I6, 0.5, 1.5, 1.8, 0.01, 0.01, 0.01, 0.001, 0.001, 0.001, 5, 5, 10I6, 10, 0.001 s, 0.001, 0.01, 0.2 s, 0.5, 1, [0.2, 0.2, 0.2, 0.02, 0.02, 0.02]T, 0.002[1, 1, 1, 0.01, 0.01, 0.01]T, 30
ASTUDESMCk1k2αiTεω1γ1/γ122λ+4ε2100I6, 50I6, 0.5, 0.001 s, 0.5, 500, 10
TDENFTSMCρ1ρ2α1iα2ik1k2L100I6, 50I6, 0.5, 1.8, 0.001 s
UDESMCc, 1/ak160, 0.001 s, 20


(51)

其中, 0t1td=1s为时间常数.

图3所示为位置跟踪误差及其放大图. 由于本文将给定时间Te设为0.2 s, 因此, 0 s至0.2 s为瞬态阶段, 0.2 s至0.5 s为稳态阶段. 对于三个平动方向, 文中预设性能函数的初始值分别为−0.1 mm与0.2 mm, 稳态值为0.001 mm与0.002 mm. 可以看出, 采用TDENFTSMC与UDESMC时, 平动方向位置跟踪误差在整个运行阶段均处于较大波动状态, 波动幅度均达到或接近1 mm, 远超出预设性能函数边界. 因此, 虽然UDE与TDE选取了较小的时间常数, 但对于快时变大扰动, 仅采用扰动观测器仍然难于取得良好的跟踪性能. 当采用ASTUDESMC时, 平动方向位置跟踪误差出现了显著减低, 瞬态阶段幅值在0.25 mm左右, 稳态阶段幅值约为0.004 mm. 虽然也超出了预设性能函数边界, 但与TDENFTSMC与UDESMC相比瞬态与稳态误差分别降低了50%与99%左右, 这是由于ASTUDESMC采用自适应超螺旋算法(Adaptive super-twisting algorithm, AST)对扰动观测误差进行补偿. 同时, 当采用本文算法时, 在整个运行阶段平动方向位置跟踪误差均在预设性能函数边界内. 对于转动方向, 预设性能函数的初始值分别为−0.001 rad与0.002 rad, 稳态值为0.0001 rad与0.0002 rad. 采用UDESMC时, 三个转动方向的稳态与瞬态误差均超出性能函数边界; TDENFTSMC算法在xz转动方向的瞬态阶段超出了性能函数边界; ASTUDESMC在z转动方向的瞬态阶段超出边界, 其他时刻均在边界内; 采用本文算法时, 角位置跟踪误差均在性能函数边界线以内. 可以看出, 采用本文提出的非对称给定时间预设性能控制时, 位置跟踪误差在瞬态与稳态阶段均可在给定时间实现预设的位置跟踪精度.

图 3  位置与角度跟踪误差
Fig. 3  Positional and angular tracking errors

图4所示为速度跟踪误差. 在平动方向上, 采用TDENFTSMC与UDESMC算法时, 平动方向的速度跟踪误差在整个运行阶段均处于大幅度波动状态, 三个平动方向的最大瞬态幅值均在7.4 mm/s与7 mm/s以上, 对应的最大稳态幅值在5.5 mm/s与3.6 mm/s以上; 当采用ASTUDESMC算法时, 三个平动方向的最大瞬态速度跟踪误差分别达到了18.7 mm/s、13.6 mm/s与12 mm/s, 稳态阶段的最大速度误差均小于0.42 mm/s, 且在0.6 s以后对应值小于0.08 mm/s, 这是由于该算法在扰动观测器基础上采用了增益较大的AST算法, 在初始阶段位置跟踪误差较大使得速度波动剧烈, 同时由于采用AST对扰动观测误差进行自适应补偿, 稳态误差与仅使用观测器进行扰动估计的TDENFTSMC与UDESMC相比显著降低; 当采用本文算法时, 三个平动方向的最大瞬态速度跟踪误差与稳态跟踪误差均小于4 mm/s与0.02 mm/s, 远小于其他三种算法. 同时, 在转动方向上, 采用本文控制算法时三个方向的瞬态误差最大, 但稳态跟踪误差最小, 对应值均小于0.00002 rad/s. 这是由于本文在进行仿真时未在转动方向施加运动, 使得采用4种控制器时转动方向上的速度跟踪误差均较小, 同时由于本文采用针对输出约束的预设性能控制, 在保证位置跟踪精度的同时, 由于动力学模型的强耦合性, 在未施加运动的转动方向瞬态速度跟踪误差较大, 而瞬态误差可保证在较小范围.

图 4  速度跟踪误差
Fig. 4  Velocity tracking error

图5所示为采用本文算法时的驱动力矩及其与其他控制算法的驱动力矩差值对比. 可以看出, 采用本文算法时驱动力矩总体较平滑, 驱动绳索3与4的最大驱动力矩值约为200 N·m, 其他各绳索的最大驱动力矩均小于100 N·m, 在实际使用中可以通过增加绳索数目以减小各绳索的最大驱动力矩或引入减速器以提高电机输出力矩进而满足使用要求. 与其他三种控制算法相比, 在初始时刻, 驱动力矩的差值约为 ± 1.5 N·m, 约为此时驱动力矩的 ± 10%, 这是由于采用不同控制算法时各关节驱动力矩分配不同及时间延迟造成的, 并未出现显著的力矩变化. 与TDENFTSMC与UDESMC相比, 在瞬态阶段的最大驱动力矩差值约为 ± 0.8 N·m, 约为此时对应驱动力矩 ± 1.6%; 在稳态阶段, 对应的最大驱动力矩差值也基本处于该水平. 同时, 采用本文算法时瞬态阶段及0.8 s至1 s之间各绳索的驱动力矩值均小于ASTUDESMC算法的对应值, 绳索6的驱动力矩差的幅值约为1.6 N·m, 其他各绳索约为0.7 N·m, 这是由于为实现高精度的跟踪性能, ASTUDESMC算法中AST更新率增益较大产生的, 其他时刻的驱动力矩差的幅值约为0.8 N·m, 与此时驱动力矩相比, 波动幅度较小. 可以看出, 采用本文算法时, 在保证较高的位置跟踪精度时, 驱动力矩并未显著增加, 且与ASTUDESMC相比, 驱动力矩反而减小.

图 5  冗余驱动绳索并联机器人驱动力矩及其差值
Fig. 5  Torques and torque deviations of the RCDPR

图6所示为采用本文算法时各绳索拉力, 经过优化, 各绳索拉力连续, 且均大于20 N, 即绳索处于拉伸状态, 符合预期要求. 图7图8分别为采用本文算法与ASTUDESMC时自适应项系数估计值. 采用本文算法时, 由于初始误差较大使得各方向的自适应项系数在初始0.1 s内急剧增加, 之后转动方向上增益基本保持稳定, 而平动方向处于缓慢上升趋势; 而当采用ASTUDESMC时, 平动方向的增益始终处于增大状态, 在终点时刻达到了500, 转动方向的增益在0.1 s后基本保持不变, 均小于0.7, 这是由于转动方向未施加运动, 模型不确定部分较小, 而平动方向施加运动使得模型不确定部分较大, 对于快时变大扰动, 虽然在算法仿真时选取的时间常数较小, 但扰动估计误差依然较大, 使得平动方向增益始终处于增加状态. 图9图10为采用本文算法时分别基于跟踪误差ez时各方向的滑模面数值. 可以看出, 由于两种误差尺度的不同, 虽然跟踪误差e可以保证在预设性能函数边界内, 且基于e计算的等效滑模面数值较小, 但基于z计算的滑模面数值在整个运行过程中处于大幅度波动状态, 平动与转动方向瞬态幅值达到了330 mm与12 rad, 稳态阶段的波动幅值达到42 mm与0.3 rad, 因此, 这也解释了采用本文算法时图7所示的变化特点. 提高式(42)中λ2值可以降低滑模面数值的变化幅度, 同时也可以减小跟踪误差, 但这将增大增益进而增大驱动力矩值, 本文引入自适应控制的目的是可以根据使用要求减小误差边界值, 并保证系统稳定性.

图 6  采用本文算法时RCDPR各绳索拉力
Fig. 6  RCDPR's pull forces of the proposed controller

图 7  采用本文算法时自适应项系数
Fig. 7  Adaptive coefficients of the proposed controller

图 8  采用ASTUDESMC时自适应项系数
Fig. 8  Adaptive coefficients of ASTUDESMC

图 9  基于跟踪误差e的滑模面数值
Fig. 9  Sliding mode surface for tracking error e

图 10  基于跟踪误差z的滑模面数值
Fig. 10  Sliding mode surface for tracking error z

因此, 从上述位置跟踪误差与力矩的对比研究以及采用本文算法时的绳索拉力及自适应项系数的仿真结果可以看出, 本文提出的控制算法可以实现冗余驱动绳索并联机器人预设性能高精度轨迹跟踪控制.

本文提出了一种考虑输出约束与扰动的冗余驱动绳索并联机器人预设性能有限时间控制算法. 为对机器人的输出进行约束, 设计给定时间衰减函数与非对称变换函数, 并将考虑预设性能的跟踪误差转换为无约束变量; 在此基础上, 设计精度驱动并在连接点处具有三阶连续性能的非奇异快速终端滑模面进行控制算法设计; 为避免滑模控制的抖振问题, 在预设性能控制中采用UDE方法对扰动项进行估计, 同时基于自适应控制对扰动估计误差进行补偿, 并从理论上证明了本文算法具有有限时间收敛特性. 最后以7自由度冗余驱动绳索并联机器人为对象进行仿真研究. 结果表明, 与TDENFTSMC、ASTUDESMC及UDESMC相比, 本文算法得到的位姿跟踪误差始终处于约束边界以内, 速度与角速度跟踪误差收敛速度快, 且驱动力矩并未显著增加, 同时绳索拉力始终不小于设定的20 N, 进而实现了冗余驱动绳索并联机器人的预设性能有限时间控制. 后续将开展具有固定时间收敛特性的扰动观测器及预设性能函数的研究, 进一步减小跟踪误差收敛时间, 同时将搭建实验平台对本文算法进行实验验证.


关键字:优秀论文

网络客服QQ: 沈编辑

投诉建议:0373-5939925    投诉建议QQ:

招聘合作:2851259250@qq.com (如您是期刊主编、文章高手,可通过邮件合作)

地址:河南省新乡市金穗大道东段266号中州期刊联盟 ICP备案号:豫ICP备2020036848

【免责声明】:中州期刊联盟所提供的信息资源如有侵权、违规,请及时告知。

版权所有:中州期刊联盟(新乡市博翰文化传媒有限公司)

关注”中州期刊联盟”公众号
了解论文写作全系列课程

核心期刊为何难发?

论文发表总嫌贵?

职院单位发核心?

扫描关注公众号

论文发表不再有疑惑

论文写作全系列课程

扫码了解更多

轻松写核心期刊论文

在线留言