气动肌肉驱动六自由度并联平台的高精度位姿控制

孟德远 ,  张猛 ,  刘送永 ,  唐超权

中国机械工程 ›› 2026, Vol. 37 ›› Issue (01) : 73 -82.

PDF (3106KB)
中国机械工程 ›› 2026, Vol. 37 ›› Issue (01) : 73 -82. DOI: 10.3969/j.issn.1004-132X.2026.01.009
机械基础工程

气动肌肉驱动六自由度并联平台的高精度位姿控制

作者信息 +

High Precision Position and Posture Control of 6-DOF Parallel Platforms Driven by Pneumatic Muscles

Author information +
文章历史 +
PDF (3180K)

摘要

针对气动肌肉输出力特性复杂、六自由度并联平台具有较大参数不确定性和模型不确定性等控制难点,采用反步法设计了基于关节空间的交叉耦合自适应鲁棒控制器,以增强关节协同运动的控制能力。该控制器为两层级联结构,每层包含一个在线参数估计模块和一个基于非线性模型的鲁棒控制模块。在线参数估计模块通过在线最小二乘参数估计减小模型参数的不确定性,鲁棒控制模块利用鲁棒控制策略减小参数估计误差、非线性建模误差和外界干扰造成的影响。实验结果表明,所设计的控制器能提高并联平台位姿控制精度。平台做升降运动、三自由度复合平移运动和六自由度位姿混合运动时,位置的平均跟踪误差不超过0.84 mm,姿态的平均跟踪误差不超过0.03°,且对干扰具有较强的性能鲁棒性。

Abstract

To address the control challenges such as the complex output force characteristics of pneumatic muscles, and the significant parameter uncertainties and uncertain nonlinearities of the 6-DOF parallel platforms, a cross-coupling adaptive robust controller in joint spaces was developed to enhance the control capability for coordinated joint motions by back-stepping method. The proposed controller featured a two-layer cascade structure. Each layer integratd an online parameter estimation module and a nonlinear model-based robust control module. The parameter estimation module employed an online recursive least square estimation algorithm to reduce the extents of parametric uncertainties, while the robust control module utilized a nonlinear robust control method to attenuate the effects of parameter estimation errors, uncertain nonlinearities and disturbances. Experimental results demonstrate that the proposed controller may significantly improve the tracking accuracy of the parallel platforms. During lifting, in the pocesses of 3-DOF composite translational motion and 6-DOF hybrid pose motion, the mean tracking error of position tracking error remains within 0.84 mm, and the mean tracking error of posture tracking error is confined to 0.03°. Furthermore, the controller exhibits strong performance robustness against disturbances.

Graphical abstract

关键词

六自由度并联平台 / 气动肌肉 / 自适应鲁棒控制 / 交叉耦合 / 运动模拟器

Key words

6-degree-of-freedom(6-DOF) parallel platform / pneumatic muscle / adaptive robust control / cross-coupling / motion simulator

引用本文

引用格式 ▾
孟德远,张猛,刘送永,唐超权. 气动肌肉驱动六自由度并联平台的高精度位姿控制[J]. 中国机械工程, 2026, 37(01): 73-82 DOI:10.3969/j.issn.1004-132X.2026.01.009

登录浏览全文

4963

注册一个新账户 忘记密码

0 引言

气动肌肉是一种利用压缩气体产生轴向拉力的执行元件,通常由管状橡胶气囊、纤维编织套管和端部连接件组成,虽然结构简单,但初始输出力比同直径气缸大10倍,且因为没有活塞装置而具有摩擦因数小、运行稳定、无爬行等优点。为增大承载力,气动肌肉驱动机构常采用并联结构。针对仿生机器人、医疗康复机构、工业机器人、运动模拟器等领域的应用需求,国内外学者在气动肌肉驱动并联平台的构型设计和运动控制策略方面进行了深入研究,但其位姿精确控制是亟需解决的难题1-3

杨钢等4设计并分析了气动肌肉驱动的三转动自由度并联平台的运动学和动力学特性,提出了基于关节空间的模糊变结构控制策略。朱笑丛等5-7针对两自由度气动肌肉并联关节提出了自适应鲁棒控制策略,使得姿态控制阶跃响应的稳态误差小于0.09°,跟踪参考轨迹θ=3sin(πt/5)+ 2sin(2πt/15)-2.5sin(2πt/21)的最大误差小于0.5°。ZUO等8在此基础上设计了具备横摇、纵摇、升降三个自由度的气缸-气动肌肉混合驱动并联平台,并针对气动肌肉慢时变的特性为该平台设计了积分式直接-间接自适应鲁棒控制器。刘昱等9设计了气动肌肉驱动的球关节并联机器人,为实现柔顺控制,研究了并联机构的阻抗控制策略。KHOA等10将气动肌肉与弹簧的组合作为执行器,设计了运动平台可沿XY轴平移、绕Z轴旋转的三自由度并联平台,研究了交叉耦合与模糊控制相结合的控制策略。周爱国等11研制了一种气动肌肉并联驱动的三自由度平台,该运动平台在气动肌肉的拉力和中轴弹簧的推力作用下保持平衡,具有一个移动自由度和两个旋转自由度。施光林等12结合模糊逻辑和小脑模型神经网络设计了气动肌肉驱动三自由度并联平台姿态跟踪控制算法,对幅值3°、频率0.1 Hz正弦信号的角度最大跟踪误差为±0.3°。

总体来看,目前的研究多关注二、三自由度的气动肌肉平台,对六自由度并联平台的研究较少。德国FESTO公司为宣传其气动肌肉产品研制了六自由度车辆驾驶模拟器,但并未将其商业化。RAMSAUER等13将气动肌肉作为驱动元件设计了六自由度平台,为弥补气动肌肉只能产生收缩力的不足,该平台使用刚度较大的弹簧支撑运动平台,并研究了逆动力学前馈补偿与PID相结合的控制方法。孟德远等14基于气动肌肉设计了六自由度并联伺服平台,将上平台设置为固定平台、下平台设置为运动平台。吴尧兴15以气动肌肉驱动的Stewart 并联机构为基础,研发了一种低成本、娱乐型的车辆驾驶模拟器,以及带有顺馈补偿的逆静力学开环运动控制方法。上述研究侧重于机构设计,对平台的控制缺乏细致研究,控制精度尤其是轨迹跟踪控制性能一般。

液压驱动的六自由度并联平台已广泛用于舰船、飞机、宇航和车载设备的动态性能和可靠性模拟试验,并已成为飞行员、船员驾驶模拟训练的重要工具16。面对中型负载时,气动肌肉驱动的六自由并联平台的功率-体积比和功率-质量比丝毫不逊于液压驱动,且具有功率-质量比高、结构简单、成本低、无污染、易维护等优点,因此解决其位姿精确控制问题必将显著提升它的应用价值。因此,本文针对气动肌肉输出力特性复杂、并联平台具有较大参数不确定性和模型不确定性等控制难点,设计了基于关节空间的交叉耦合自适应鲁棒控制器,一方面使用在线参数辨识减小模型误差,另一方面通过基于非线性模型的鲁棒控制和交叉耦合控制确保系统稳定,并减小参数估计误差、非线性建模误差和外界干扰造成的影响,保证气动肌肉驱动的六自由度并联平台具有较高位姿轨迹跟踪控制精度。

1 六自由度并联平台结构与数学模型

1.1 并联平台结构

图1所示,气动肌肉驱动的六自由度并联平台主要由固定平台(上平台)、运动平台(下平台)、气动肌肉组成。气动肌肉与固定平台和运动平台均用铰链连接,绞点分别用GiPii=1,2,…,6)表示,如图2所示。固定平台的3组绞点对称分布在半径为rg的虚拟圆上,组内2个绞点的中心角为β;运动平台的3组绞点对称分布在半径为rp的虚拟圆上,组内2个绞点的中心角为α

气动肌肉型号为DMSP-20-RM-CM,气源压力为0.6 MPa时,最大输出力可达1500 N。每根气动肌肉由2个高速开关阀(MHE2-MS1H-3/2G-M7-K)控制,通过调节气动肌肉腔内气压来改变气动肌肉的长度及对运动平台的作用力矩,进而控制运动平台的位姿。

1.2 并联平台数学模型

图2所示,在固定平台、运动平台中心分别建立静坐标系OgXgYgZg和动坐标系OpXpYpZp,运动平台在静坐标系中的广义位姿 q =(x,y,z,φ,θ,ψT,其中,φθψ为运动平台的RPY转角,动坐标系原点Op在静坐标系中的位置 t =(x,y,zT,则六自由度并联平台的工作空间到关节空间的状态变换公式为

Li=-gi+gpRpi+t
gpR=cψcθcψsθsφ-sψcφsψsφ+cψsθcφsψcθcψcφ+sψsθsφsψsθcφ-cψsφ-sθcθsφcθcφ

sk =sin k ck =cos k k=φθψ

式中: Li 为第i根气动肌肉在静坐标系中的长度向量; gi 为第i根气动肌肉与固定平台铰接点在静坐标系中的位置向量; pi 为第i根气动肌肉与运动平台铰接点在动坐标系中的位置向量;gpR为动坐标系相对于静坐标系的旋转变换矩阵。

因此,根据运动平台的期望位姿可计算出气动肌肉i的当前理想长度:

li=(-gi+gpRpi+t)T(-gi+gpRpi+t)

假设气动肌肉的初始长度为l0,则其收缩量xi =l0-li,令 L =(x1,x2,x3,x4,x5,x6T,则关节空间中六自由度并联平台的数学模型为

ML¨=F-FL+fn+f˜0

M =diag(m1m2,…,m6

F =[F1F2F3F4F5F6T

FL=T p-1(Mpq¨+Cpq˙+Gp)

式中: M 为并联平台关节空间中的惯量矩阵; F 为气动肌肉拉力向量; FL为气动肌肉驱动运动平台时受到的负载力17fn为模型误差在线辨识部分;f˜0为模型误差中未辨识部分及外界干扰;mi 为运动平台及其连接件总质量的1/6; Tp为并联六自由度机构的力雅可比矩阵; Mp为运动平台的广义质量阵; Cp为运动平台非线性科氏向心项系数矩阵; Gp为运动平台的重力。

气动肌肉的输出力与其腔内压力和收缩量有关18-19

Fi =piaxi )+bxi
a(xi)=m=03amximb(xi)=n=04bnxin

式中:pi 为气动肌肉i腔内气体的绝对压力;am 为可通过离线参数辨识获得的量;bn 为多项式系数。

气动肌肉充放气时,其腔内气体压力的变化可近似用如下方程描述:

p˙i=qigP(xi)+FP(xi,x˙i,pi)+din+d˜i0
gP(xi)=λRTi/ViFP(xi,x˙i,pi)=-λpiV˙i/Vi

式中:qi为通过高速开关阀流进或流出气动肌肉i的气体质量流量;dind˜i0分别为气动肌肉i压力动态建模误差与外界干扰的标称值(可通过在线参数辨识进行补偿)和高频分量;λ为多变系数;R为理想气体常数;Ti 为气动肌肉内腔气体的绝对温度;ViV˙i分别为气动肌肉i内腔的体积和体积变化率。

采用载波频率为100 Hz的PWM信号控制高速开关阀,通过阀口的气体质量流量方程为

qi=uikqi(pui,pdi,Tui)
kqi(pui,pdi,Tui)=Aepui(2c+1)1/(c-1)2cTuiR(c+1)                      pdipui0.528Aepui2cTuiR(c-1)[(pdipui)2/c-(pdipui)1+1/c]     pdipui>0.528

式中:ui 为PWM占空比;Ae为最大有效阀口面积;puipdi 分别为阀口上下游的绝对压力;Tui 为阀口上游气体温度;c为空气比热容。

2 控制器设计

气动肌肉驱动的六自由度并联平台的主要控制难点包括:①系统具有强非线性;②系统模型存在未建模动态(气动肌肉腔内气体的温度动态等)和建模误差(摩擦力、泄漏、质量流量方程等);③系统模型具有严重的参数不确定性;④在关节空间设计控制器虽简单,但关节协同运动控制性能易受关节负载力估计误差和干扰的影响。针对上述问题,采用反步法设计交叉耦合自适应鲁棒控制器对运动平台进行位姿控制,保证做六自由度位姿混合运动时具有毫米级的平移控制精度和0.5°的姿态控制精度。

图3所示,控制器为两层级联结构,每层各包含一个基于非线性模型的鲁棒控制模块和在线参数估计模块,使用标准投影映射方法让参数自适应律与鲁棒控制律的设计相互独立。

2.1 在线参数估计算法设计

假设系统仅具有参数不确定性,并联平台第i个驱动关节的数学模型可重新表述为

mix¨i=a(xi)pi+b(xi)-FiL+finp˙i=qigP(xi)+FP(xi,x˙i,pi)+din

定义未知参数

θia=(θia1,θia2,θia3,θia4,θia5)θib=θib1
θia1=b0+finθia2=b1θia3=b2
θia4=b3θia5=b4θib1=din

式(8)可写成线性回归模型:

yia=a(xi)pi-FiL-mix¨i=φia·θiayib=qigP(xi)+FP(xi,x˙i,pi)-p˙i=φibθib
φia=(-1,-xi,-xi2,-xi3,-xi4)φib=-1

为减小测量噪声对在线参数估计过程的干扰,在式(9)的等号两边同时乘以线性时不变低通滤波器Hf(s)=ωf2(τfs+1)(s2+2ξωfs+ωf2),可得

yiaf=Hf(pia(xi)-FiL-mix¨i)=φiaf·θiayibf=Hf(qigP(xi)+FP(xi,x˙i,pi)-p˙i)=φibfθib
φiaf=(-1f,-xif,-xif2,-xif3,-xif4)φib=-1f

式中:yiafyibf-1f-xif分别为yiayib-1、-xi 经过滤波器Hf的输出值。

使用任何方式都无法绝对精确估计未知参数向量 θiaθib,但其变化范围在实际中是可以预测的,因此可作出如下合理假设20

θiaΩ(θia){θia:θiaminθiaθiamax}θibΩ(θib){θib:θibminθibθibmax}

θiamin=θia1minθia2minθia3minθia4minθia5min

θibminib1min

θiamax=θia1maxθia2maxθia3maxθia4maxθia5max

θibmaxib1max

其中,运算符“≤”表示两个向量对应元素的大小关系, θiaminθibmin为未知参数的最小值向量, θiamaxθibmax为未知参数的最大值向量。用θ^iaθ^ib表示 θiaθib的估计值,用y^iaf=φiaf·θ^iay^ibf=φibfθ^ib表示yiafyibf的预测输出,则yiafyibf的预测误差为

εij=y^ijf-yijf=φijf·θ˜ij

式中:θ˜ijθij的估计误差,j=a,b。

设计参数自适应律时,使用标准投影映射Proj(·)限制参数估计值,使其始终在已知界Ω¯(θia)Ω¯(θib)Ω(θia)Ω(θib)的闭包集)内,保证参数自适应过程在有干扰时仍能良好可控;同时采用饱和函数sat(·)限制参数更新速度,使在线参数估计算法和鲁棒控制器的设计完全分离,进而用收敛较快的递归最小二乘法进行在线参数估计21,因此,采用如下的参数自适应律:

θ^˙ij=satθ˙ijM(Projθ^(Γijτij))θ^ij(0)Ω(θij) 

式中:Projθ^·为标准投影映射; Γij 为正定且对称的自适应率矩阵;τij 为自适应函数。

饱和函数定义如下:

satθ˙ijM(x)=x                    ||x||θ˙ijMθ˙ijM/||x||        ||x||>θ˙ijM

式中:θ˙ijM为预先设定的参数最大更新速度。

自适应率矩阵为

Γ˙ij=αijΓij-ΓijφijfφijfTΓij/(1+νijφijfTΓijφijf)           λmax(Γijt)ρijMProjθ^(Γijτij)θ˙ijM0        其他

式中:αij 为遗忘因子,αij0νij 为归一化因子,νij0ρijM是对Γijt预设的上界,保证Γij(t)ρijMI,t

自适应函数为

τij=φijfεij1+νijφijfTΓijφijf

参数自适应律具有如下性质:

θ^ij(t)Ω¯(θij)                                        tθ˜ijT(Γij-1Projθ^(Γijτij)-τij)0        τijθ^˙ij(t)θ˙ijM                                           t

2.2 鲁棒控制器设计

根据六自由度并联平台的期望位姿 qd=(xd,yd,zd,φd,θd,ψdT和气动肌肉的初始长度,利用式(1)式(2)可得到气动肌肉的期望收缩量 Ld=(x1d,x2d,x3d,x4d,x5d,x6dT。利用反步法设计非线性鲁棒控制器以减小参数估计误差和未建模动态的影响,使气动肌肉的实际收缩量尽可能按照期望值变化。为提高平台的抗干扰能力,防止某支链受到干扰、控制误差增大后,其他支链的控制器不能及时响应变化、严重影响平台的位姿控制精度,将交叉耦合策略引入非线性鲁棒控制器设计,即根据气动肌肉关节实际收缩量和期望收缩量的比值计算同步误差(用于评价关节协同运动控制质量),将同步误差和气动肌肉收缩量误差以某种设定模式组成一个新变量(称为耦合误差),并利用该误差的反馈设计关节控制器,使关节误差和同步误差同时收敛。鲁棒控制器的具体设计过程如下。

2.2.1 步骤1

设平台的控制误差 e = L-Ld,定义关节之间的同步误差

ς=Tae
T=2-1000-1-12-10000-12-10000-12-10000-12-1-1000-12
a=1/x1d1/x2d1/x6dT

式(18)用同步误差ςi=2xi/xid-xi-1/x(i-1)d-xi+1/x(i+1)d衡量各关节运动的协同控制质量,值越小,协同性越好,平台位姿控制精度越高。在此基础上,定义耦合误差

Ε=e+ηTT0tςdω

式中:η为耦合系数,用于调整同步误差在耦合误差中所占的比重。

定义一个类似滑模面的变量r=Ε˙+ΛΕ,其中,正定反馈增益矩阵 Λ =diag(ΛΛ),根据传递函数特性可知 r 收敛于0时, E 也收敛于0(收敛速度与 Λ 相关)。对 r 求导,可得

r˙=e¨+ηΤΤς˙+Λe˙+ΛηΤΤς

定义半正定函数

V1=12rΤMr+12ςΤKςς+12(0tΤΤςdω)ΤηΛKς(0tΤΤςdω)
Kς=diag(Kς,Kς,Kς,Kς,Kς,Kς)

式中: Kς 为正定矩阵。

V1对时间求导并代入式(4)式(20),同时结合式(5)式(9)可得

V˙1=ςΤKςς˙+(0tΤΤςdω)ΤηΛKςΤΤς+rΤ[a(x)P-
φaTθa-FL+f˜0-ML¨d+MηΤΤς˙+MΛE˙]
P=p1    p2    p3    p4    p5    p6T
a(x)=diag(a(x1),a(x2),,a(x6))
θa=[θ1aθ2aθ6a]
φa=[φ1aφ2aφ6a]

P看成是步骤1的虚拟控制输入,利用鲁棒控制理论设计期望的虚拟控制输入为

Pd=Pda1+Pda2+Pds1+Pds2
Pda1=a-1(x)(φaTθ^a+FL+ML¨d-MηΤΤς˙-
MΛE˙-KςΤΤς)
Pds1=-a-1(x)Kpr

式中:Pda1为非线性模型补偿项;θ^aθa的在线估计值;Pds1r 的比例反馈项,保证鲁棒控制器处于切换层内部时系统是稳定、收敛的;Kp=diag(Kp1,Kp2,Kp3,Kp4,Kp5,Kp6),是正定反馈增益矩阵; Pda2为快速动态补偿项; Pds2为鲁棒反馈项。

eP=P-Pd表示实际和期望虚拟控制输入间的误差,将式(23)代入式(22)可得

V˙1=rΤa(x)ep-rΤKpr-rΤKςΤΤς+ςΤKςς˙+
(0tΤΤςdω)ΤηΛKςΤΤς+rΤ(a(x)Pda2+
a(x)Pds2-φaTθ˜a+f˜0)
θ˜a=θ^a-θa

r=Ε˙+ΛΕ代入式(24)中的rΤKςΤΤς项,则式(24)可化简为

V˙1=rΤa(x)ep-rΤKpr-(ΤΤς)ΤηKς(ΤΤς)-
ςΤΛΤKςς+rΤ(a(x)Pda2+a(x)Pds2-φaTθ˜a+f˜0)

dc1表示参数估计误差、模型误差中未辨识部分和外界干扰的低频分量, Δ1t)表示参数估计误差、模型误差中未辨识部分和外界干扰的高频分量,即

dc1+Δ1t=-φaTθ˜a+f˜0
d^c1=projd^c1(γc1r)=0            d^c1(t) =dc1Md^c1T(t)r>0γc1r        其他

式中:γc1=diag(γc11,γc12,γc13,γc14,γc15,γc16)为正定的自适应率矩阵;dc1M为预先设定的边界,dc1M>0。

d^c1的初值d^c10dc1M,则自适应律(式(27))保证了d^c1tdc1M,t。在此基础上,可以利用快速动态补偿项 Pda2dc1进行补偿:

Pda2=-a-1xd^c1

式(26)式(28)代入式(25)可得

V˙1=rΤa(x)ep-rΤKpr+rΤ(a(x)Pds2-d˜c1+Δ1(t))-(ΤΤς)ΤηKς(ΤΤς)-ςΤΛΤKςς=rΤa(x)ep+V˙1|Pd
d˜c1=d^c1-dc1

系统干扰的变化范围在实际工作中是可以预测的,因此假设f˜0有界且满足f˜0Ω(f˜0){f˜0:f˜0fmax},其中,fmax为已知的正值。因此,-d˜c1+Δ1(t)的界为

h1tdc1M+θaMφa+fmax
θaM=θamax-θamin

最后,利用鲁棒反馈项 Pds2减小d˜c1Δ1(t)的影响:

Pds2=-a-1(x)h12(t)4η1r

式中:η1为滑模控制边界层厚度,η1>0。

由鲁棒控制理论可知rΤ[a-1(x)pds2-d˜c1+Δ1(t)]η1,因此V˙1满足

V˙1rΤaxep-rΤKpr-ΤΤςΤηKςΤΤς-
ςΤΛΤKςς+η1

由此可知,若eP=0,则 rςEΕ˙都会有界,且这个界可通过增大 Kp或减小η1来减小。由式(18)可知,ς有界意味着关节控制误差 e 有界。

2.2.2 步骤2

eP对时间微分并结合式(6)可得

e˙p=qL+Fp-φbTθb+d˜0-p˙d
qL=[q1gP(x1)q2gP(x2)q6gP(x6)]T
θb=[θ1b    θ2b    θ3b    θ4b    θ5b    θ6b]
φb=[φ1b    φ2b    φ3b    φ4b    φ5b    φ6b]
Fp=[FP(x1,x˙1,P1)   FP(x2,x˙2,P2)      FPx6,x˙6,P6]T

再定义半正定函数

V2=V1+12epTep

V2对时间求导并将式(29)式(33)代入式(34)可得

V˙2=V˙1|pd+epT(qL+a(x)r+Fp-φbTθb+d˜0-p˙d)

与步骤1类似,为使 ep趋近于零,将 qL作为虚拟控制输入,则为 qL设计的期望虚拟控制输入为

qLd=qLda1+qLda2+qLds1+qLds2
qLda1=-axr-Fp+φbTθ^b+P˙dqLds1=-Kqep

式中: qLda1为非线性模型补偿项;θ^bθb的在线估计值; qLds1ep的比例反馈,用于保证鲁棒控制器处于切换层内部时系统的稳定性; Kq=diag(Kq1Kq2,…,Kq6),是正定反馈增益矩阵; qLda2qLds2分别为待定的快速动态补偿项和鲁棒反馈项。

式(36)代入(35)可得

V˙2=V˙1|pd+epT(qLda2+qLds2-φbTθ˜b+d˜0)
θ˜b=θ^b-θb

式(26)类似,式(37)中的参数估计误差、模型误差中未辨识部分和外界干扰可分解为低频分量 dc2和高频分量 Δ2t),即

dc2+Δ2(t)=-φbTθ˜b+d˜0

与步骤1类似,在线估计低频分量 dc2并利用快速动态补偿项 qLda2进行补偿:

qLda2=-d^c2
d^˙c2=projd^c2(γc2ep)=0              d^c2(t)=dc2Md^c2T(t)ep>0γc2ep        其他

式中:d^c2是对 dc2的估计; γc2=diag(γc21γc22,…,γc26)为正定的自适应率矩阵;dc2M是预先设定的边界,dc2M>0。

需要指出,d^c2初值d^c2(0)dc2M,这样自适应律式(40)保证了d^c2(t)dc2M,t。将式(38)式(39)代入式(37)可得

V˙2=V˙1|pd-epTKqep+epT[qLds2-d˜c2+Δ2(t)]
d˜c2=d^c2-dc2

假设d˜0有界,并满足d˜0Ω(d˜0){d˜0:d˜0

dmax},其中,dmax为已知的正值。因此,-d˜c2+Δ2(t)的界为

h2t=dc2M+θbMφb+dmax
θbM=θbmax-θbmin

鲁棒反馈项

qLds2=-h22(t)4η2ep

式中:η2为滑模控制边界层厚度,η2>0

用于抑制d˜c2Δ2t)的影响。同样可知epT[qLds2-d˜c2+Δ2(t)]η2,所以V˙2满足

V˙2-rΤKpr-epTKqep-(ΤΤς)ΤηKς(ΤΤς)-
ςΤΛΤKςς+η1+η2

由此可知V˙2半负定,可通过增大 KpKq或减小η2η3使 ep趋近于零,从而保证关节控制误差 e 有界。

关节i控制阀的期望占空比为

ui=qLdigPxikqi(Ps,Pi,Ts)        qLdi0qLdigPxikqi(Pi,P0,Ts)        qLdi<0

式中:PsP0分别为气源和大气的压力;Ts为室温。

3 实验结果

图1所示的实验台上对控制器的有效性进行验证,并与3种常见的控制器作对比。其中,交叉耦合自适应鲁棒控制器C1的参数见表1。与C1相比,自适应鲁棒控制器C2不包含同步误差反馈,即设定η=0。与C2相比,确定性鲁棒控制器C3不包含参数自适应部分和快速动态补偿项,即设定 Γia= Γib=0γc1= γc2=0。PID控制器C4设定比例增益kp=43,积分增益ki=0.05,微分增益kd=1。

图4为实验台照片,气动肌肉收缩量测量采用拉线式位移传感器(MIRAN MPS-S-100MM-P),腔内压力测量采用压力传感器(FESTO SPTW- P10R-G14-VD-M12),阀控制信号的产生和各传感器信号的读取利用dSPACE DS1103 完成。

eq=(eq1eq2,…,eq6T= q-qd表示并联平台在工作空间的位姿控制误差。气动肌肉仅能提供拉力,在控制初始时刻需要先向其预充气、将运动平台提升至 “初始零位置”的高度。图5所示为初始零位置并联平台的位姿控制误差,其中,位置控制误差不超过0.11 mm,姿态控制误差不超过0.03°。

3.1 升降运动

仅在升降方向跟踪运动轨迹zd=30sin(πt/5)时,4个控制器的稳态响应如图6所示,最大跟踪误差|eq3|max=max|eq3|和平均跟踪误差eq3rms=1T0Teq32dt表2

系统存在强非线性和参数不确定性,在某一工作点通过反复调整确定的PID控制器参数无法保证全局都有良好的表现。所设计的交叉耦合自适应鲁棒控制器C1性能最好,最大跟踪误差为2.12 mm,平均跟踪误差不超过0.84 mm,与传统的自适应鲁棒控制器C2相比,分别减小54%与64%,表明耦合误差反馈实现了各关节运动控制的协同,显著提高了平台位姿跟踪控制性能。控制器C2的最大跟踪误差和平均跟踪误差相比控制器C3分别减小30%与21%,表明在线参数辨识减小了模型参数的不确定性,提高了轨迹跟踪精度。此外,控制器C3仅依靠鲁棒控制减小模型不确定性和干扰的影响,实验表明随着控制器增益的增大,气动肌肉与运动平台的颤振会迅速加剧,限制了控制性能的提高。

图7所示为控制器C1对第一支链气动系统的参数在线估计过程,可以被估计的模型参数逐渐收敛于某一固定值或缓慢变化,这证明基于递归最小二乘法设计的在线参数估计算法是有效的。

3.2 三自由度复合运动

并联平台姿态保持不变时,控制器C1对空间复合曲线的轨迹跟踪误差和响应曲线如表3图8所示。该曲线沿XYZ三轴分解后,运动平台的期望平移运动轨迹为xd=tyd=24sin(0.1πt-

π/4)+2,zd=30sin(0.1πt-π/4)。运动平台的实际运动轨迹与期望曲线重合度较高,最大跟踪误差不超过1.76 mm,平均跟踪误差不超过0.53 mm,气动肌肉驱动的六自由度并联平台具有较好的空间平移运动控制能力。

3.3 六自由度位姿混合控制

图9所示为并联平台同时进行平移和转动控制时的表现,各自由度上的期望运动轨迹见表4。并联平台能较好跟踪期望运动轨迹,平移运动的平均跟踪误差都在0.42 mm以下;3个旋转自由度的最大跟踪误差不超过0.56°,平均跟踪误差在0.03°以下。

3.4 抗干扰验证

并联平台在升降方向跟踪期望轨迹zd=10 sin(0.25πt)+10sin(0.2πt)+10sin(0.15πt)时,突然对运动平台施加一个额外负载力(垂直于运动平台,大小为154 N),如图10所示,控制误差只在干扰出现(第18 s)和退出(第42 s)时刻有所增大,其他时间的并联平台运行平稳,这表明交叉耦合自适应鲁棒控制器C1能迅速应对变化,干扰没有明显影响系统的控制性能。

4 结论

为气动肌肉驱动的六自由度并联平台设计了基于关节空间的交叉耦合自适应鲁棒控制器。该控制器通过在线最小二乘参数估计减小模型参数的不确定性,利用基于反步法设计的非线性鲁棒控制减小参数估计误差、非线性建模误差、外干扰的影响,引入交叉耦合策略增强关节协同运动控制能力,实现并联平台的位姿精确控制。实验表明该控制器性能明显优于自适应鲁棒控制、确定性鲁棒控制与PID控制,且对外干扰具有较强的性能鲁棒性。不足之处是控制器较复杂、参数较多且依赖实验确定,下一步将研究控制器参数的快速确定方法。

参考文献

[1]

ZHANG JunSHENG JunO’NEILL C Tet al. Robotic Artificial Muscles: Current Progress and Future Perspectives[J]. IEEE Transactions on Robotics201935(3): 761-781.

[2]

ANDRIKOPOULOS GNIKOLAKOPOULOS GMANESIS S. A Survey on Applications of Pneumatic Artificial Muscles[C]∥2011 19th Mediterranean Conference on Control & Automation (MED). Corfu island, 2011: 1439-1446.

[3]

KALITA BLEONESSA ADWIVEDY S K. A Review on the Development of Pneumatic Artificial Muscle Actuators: Force Model and Application[J]. Actuators202211(10): 288.

[4]

杨钢, 李宝仁. 基于CMAC的气动人工肌肉变结构位置控制研究[J]. 机械工程学报200440(10): 92-96.

[5]

YANG GangLI Baoren. CMAC-based Variable Structure Position Control of a Pneumatic Muscle Actuator System[J]. Chinese Journal of Mechanical Engineering200440(10): 92-96.

[6]

朱笑丛, 陶国良, 曹剑. 气动肌肉并联关节的位姿轨迹跟踪控制[J]. 机械工程学报200844(7): 161-167.

[7]

ZHU XiaocongTAO GuoliangCAO Jian. Posture Trajectory Tracking Control of Parallel Manipulator Driven by Pneumatic Muscles[J]. Chinese Journal of Mechanical Engineering200844(7): 161-167.

[8]

朱笑丛, 陶国良. 气动人工肌肉伺服平台的建模[J]. 浙江大学学报(工学版)200438(8): 1056-1060.

[9]

ZHU XiaocongTAO Guoliang. Modeling of a Servo Platform Driven by Pneumatic Artificial Muscles[J]. Journal of Zhejiang University (Engineering Science)200438(8): 1056-1060.

[10]

ZHU XiaocongTAO GuoliangYAO Binet al. Adaptive Robust Posture Control of a Parallel Manipulator Driven by Pneumatic Muscles[J]. Automatica200844(9): 2248-2257.

[11]

ZUO HeTAO Guoliang. Cross-coupling Integral Adaptive Robust Posture Control of a Pneumatic Parallel Platform[J]. Journal of Central South University201623(8): 2036-2047.

[12]

刘昱, 王涛, 范伟. 基于气动肌肉群驱动球关节机器人结构及阻抗控制[J]. 机械工程学报201349(15): 28-33.

[13]

LIU YuWANG TaoFAN Wei. Mechanism and Impedance Control of the Ball Universal Joint Robot Driven by the Pneumatic Muscle Actuator Group[J]. Journal of Mechanical Engineering201349(15): 28-33.

[14]

KHOA L DTRUONG D QAHN K K. Synchronization Controller for a 3-R Planar Parallel Pneumatic Artificial Muscle (PAM) Robot Using Modified ANFIS Algorithm[J]. Mechatronics201323(4): 462-479.

[15]

周爱国, 施光林, 钟廷修, . 气动人工肌肉并联驱动多自由度平台的系统设计[J]. 液压与气动200428(5): 41-43.

[16]

ZHOU AiguoSHI GuanglinZHONG Tingxiuet al. System Design of Multi-DOF Platform Driven by Pneumatic Artificial Muscle[J]. Chinese Hydraulics & Pneumatics200428(5): 41-43.

[17]

施光林, 沈伟. 气动人工肌肉并联平台自适应模糊CMAC姿态跟踪控制[J]. 中国机械工程201223(2): 171-176.

[18]

SHI GuanglinSHEN Wei. Adaptive Fuzzy CMAC Position Tracking Control of Parallel Platform Based on Pneumatic Artificial Muscles[J]. China Mechanical Engineering201223(2): 171-176.

[19]

RAMSAUER MKASTNER MFERRARA Pet al. A Pneumatically Driven Stewart Platform Used as Fault Detection Device[J]. Applied Mechanics and Materials2012186: 227-233.

[20]

孟德远, 魏伟, 李艾民, . 一种基于气动肌肉的六自由度并联伺服平台: CN105139895A[P]. 2015-12-09.

[21]

Meng DeyuanWei WeiLi Aiminet al. Six-degree-of-freedom Parallel Servo Platform Based on Pneumatic Muscles: CN105139895A[P]. 2015-12-09.

[22]

吴尧兴. 基于气动人工肌肉的低成本车辆驾驶模拟器开发[D]. 哈尔滨: 哈尔滨工业大学, 2020.

[23]

Wu Yaoxing. Development of Low-cost Vehicle Driving Simulator Based on Pneumatic Artificial Muscles[D]. Harbin: Harbin Insitute of Technology, 2020.

[24]

张凯临, 张文静, 秦胜光. 海上漂浮式激光雷达运动平台模拟器设计及应用[J]. 中国海洋大学学报(自然科学版)202252(12): 134-141.

[25]

ZHANG KailinZHANG WenjingQIN Shengguang. Design and Application of Offshore Floating Lidar Motion Platform Simulator[J]. Periodical of Ocean University of China202252(12): 134-141.

[26]

DASGUPTA BMRUTHYUNJAYA T S. Closed-form Dynamic Equations of the General Stewart Platform through the Newton-Euler Approach[J]. Mechanism and Machine Theory199833(7): 993-1012.

[27]

ASCHEMANN HSCHINDELE D. Sliding-mode Control of a High-speed Linear Axis Driven by Pneumatic Muscle Actuators[J]. IEEE Transactions on Industrial Electronics200855(11): 3855-3864.

[28]

WU JunHUANG JianWANG Yongjiet al. Nonlinear Disturbance Observer-based Dynamic Surface Control for Trajectory Tracking of Pneumatic Muscle System[J]. IEEE Transactions on Control Systems Technology201422(2): 440-455.

[29]

YAO BinTOMIZUKA M. Adaptive Robust Control of SISO Nonlinear Systems in a Semi-strict Feedback Form[J]. Automatica199733(5): 893-900.

[30]

MENG DeyuanTAO GuoliangZHU Xiaocong. Integrated Direct/Indirect Adaptive Robust Motion Trajectory Tracking Control of Pneumatic Cylinders[J]. International Journal of Control201386(9): 1620-1633.

基金资助

国家自然科学基金(51505474)

流体动力与机电系统国家重点实验室开放基金(GZKF-202210)

AI Summary AI Mindmap
PDF (3106KB)

0

访问

0

被引

详细

导航
相关文章

AI思维导图

/