摘要
为了解决气动人工肌肉驱动的下肢康复机器人轨迹跟踪中存在外界干扰和系统参数不确定的问题,提出了一种关节控制自抗扰算法。该方法在气动人工肌肉关节伺服控制系统数学模型基础上,通过三阶状态扩张观测器对系统状态及系统干扰进行估计,对干扰进行实时补偿,并基于分离性原理进行参数整定;利用气动人工肌肉试验平台对控制系统进行定角度条件下的阶跃信号跟踪控制、方波跟踪控制和正弦跟踪控制对比验证实验。实验结果表明:所设计的自抗扰控制器较比例-积分-微分(proportion integration differentiation,PID)控制器响应时间更快、控制误差更低,满足下肢康复机器人的应用控制要求。
气动人工肌肉(pneumatic artificial muscle,PAM)是一种类似人体肌肉的仿生驱动器,具有功率/质量比大、柔顺性强等特点,可广泛用于具有高频、强非线性运动特征的系统驱动,如踝关节康复机器人、农业采摘机器人
当前气动人工肌肉在快速响应和精确控制上仍是学术界的一大难题。由于气体的可压缩性,气动人工肌肉具有非线性和迟缓等特
这些控制方法的效果大多取决于系统模型或直观经验。因为内外部条件的复杂性和未知性,加上气动人工肌肉自身良好的柔顺性,此类控制方法的效果不稳定。在实际应用中,以气动人工肌肉作为驱动的下肢康复机器人的控制策略主要为位置控制,位置控制策略要求控制系统精度高和响应速度快。因此,笔者以下肢康复机器人的关节为研究对象,针对高速开关阀驱动的气动人工肌肉,设计了基于自抗扰控制(active disturbance rejection control,ADRC)的二阶自抗扰控制器,该控制器的实现不需要依赖准确的气动人工肌肉数学模型。为了验证所设计的ADRC控制器效果,建立了单自由度气动肌肉位置伺服系统试验台,在试验台上进行了阶跃、方波和正弦输入信号跟踪试验,最后与PID控制试验结果进行对比分析和验证。
气动人工肌肉PAM主要由橡胶管和外覆的纤维编制网和两端连接头组成,通过充/放气可实现单向直线运动和复原运动。当充气时,压缩气体进入气动人工肌肉腔内,腔内压力增强,气动人工肌肉的橡胶管径向膨胀并带动编织袋角度变化,气动人工肌肉的直线长度方向产生收缩力,带动外接负载运动。当腔内压缩气体被释放时,气动人工肌肉的径向和轴向都逐渐恢复原样。
下肢康复机器人运动控制的对象是各个关节,与关节相连接的是驱动元件——气动肌肉,通过双气动肌肉之间的相互作用带动关节的转动。对拉式布置的双气动人工肌肉因为其单向收缩性,在关节转动处于极限位置(顺时针或逆时针转角的最大值)时,一个气动人工肌肉处于充气的最大压力,另一个气动人工肌肉的压力等于大气压力,此时前者处于收缩极限,后者则处于拉伸极限。当处于中间某些位置时,2个肌肉会处于充气状态,所以,问题在于0点位置的选择。文中实验选择2根气动肌肉处于充气状态下的相对平衡状态作为0点位置,由此搭建了基于高速开关阀的气动人工肌肉驱动的单关节伺服位置控制研究试验台。原理图如

图1 双PAM试验台控制原理图
Fig. 1 Control schematic diagram of dual PAM test bench

图2 PAM试验台实物图
Fig. 2 Physical image of PAM test bench
压缩气体经减压阀、高速开关阀(MHE2-MS1H-3/2G-QS-4-K)接入PAM。采用2个高速开关阀为一组控制单根气动人工肌肉的充气和排气,其中阀1和阀3都各自有一个排气口被堵塞,可作为两位两通阀使用。以气动人工肌肉PAM1为例,如
气动人工肌肉的静态模型表征气动人工肌肉的收缩力、内腔压力和长度之间的函数关系,将气动人工肌肉视为理想圆柱体,根据虚功原理可得到静态数学模
。 | (1) |
式中:R0为气动人工肌肉初始状态半径;k0为修正参数;ε为气动人工肌肉收缩率,ε=(E0-E1)/E0,E0和E1分别为气动人工肌肉初始状态长度和收缩时的长度;p为气动人工肌肉内腔压力;A=3/tan2γ,B=e/sin2γ,γ为气动人工肌肉初始状态编织角。
高速开关阀内,气体在运动过程中受到各方面的影响,使用Sanvile公式计算它的质量流
(2) |
式中:Qg为气体质量流量;u为输入脉宽调制信号占空比;S为阀口流通有效截面积;R1为临界压力比;p1和p2分别为上游、下游压力;T为气源温度;K为气体绝热指数;C为气体常数。
脉宽调制信号决定开关阀的工作状态,脉宽调制信号的基频下限不能低于100 Hz,上限不能高于180 Hz,在试验时设定为150 Hz。占空比与气体质量流量的相对关系会传递出一种线性变
气动人工肌肉腔室在内部体积有限的情况下的绝热充/放气过程,仍然遵守热力学能量守恒方程,依此可得气动人工肌肉的能量守恒方程为
, | (3) |
式中,V为气动肌肉收缩过程中腔室体积。
对于气动人工肌肉有
, | (4) |
, | (5) |
式中:e为气动人工肌肉的单根纤维长度;E为气动肌腱长度;D为气动人工肌肉的横截面直径;n为纤维缠绕圈数;θ为同步带轮转角。
。 | (6) |
取V取值为气动人工肌肉充气体积的均值。此时,可将
, | (7) |
式中,。
由
。 | (8) |
同理,由
。 | (9) |
对系统作动力学分析可得出单关节的转矩为
, | (10) |
式中:m为负载质量;r为同步带轮半径;ζ为系统阻尼系数;F1、F2为双气动人工肌肉的张力;en为连杆长度;I为连杆转动惯量。
选取X1、X2、X3为系统状态变量,令X1=θ、X2=dθ/dt、X3=p,则系统状态方程为
(11) |
自抗扰控制器(ADRC)主要由跟踪微分器(tracking differentiator,TD)、扩张状态观测器(extended state observer,ESO)、非线性状态误差反馈(nonlinear state error feedback,NLSEF)组
利用
, | (12) |
式中:为系统内部扰动;G为补偿系数;w为外部扰动。

图3 不依赖于模型的ADRC控制图
Fig. 3 Model independent ADRC control chart
自跟踪微分器接收信号x(t)始,经处理得到跟踪信号x1和微分信号x2,并且x2=dx1/dt。利用二阶最速开关系统构造二阶跟踪微分
(13) |
再次对系统进行离散化
(14) |
式中:h和r1是可控制参数;h为采样步长。
得到最速综合函数fhan
(15) |
(16) |
式中,δ为函数fal在原点附近的线性区间宽度,再利用最速综合函数建立离散最速反馈系
(17) |
式中:h0为滤波因子;r1为微分器的带宽或响应速度的调节参数;k1为微分器对输入信号变化的放大程度;v0为系统初始状态;d为系统的动态特性或状态变量的变化率;sa为饱和函数。
参数r1的大小与x1跟踪信号x的速度密切相关,其值与跟踪时间呈负相关,但r1过大会引起高频脉冲噪声进而影响信号。因此,r1越小,跟踪信号越好。
跟踪微分器输出输入信号各阶导数x1、x2,而Z1、Z2相当于状态的估计量,在跟踪输入信号x(t)时的状态误差便和2组变量存在一定关系,用它们之间的非线性约束来实现非线性状态误差反
(19) |
可得控制量为
, | (20) |
式中:β1、β2、b均为可控制参数。当实验中控制量u(k)为正且非0时,开关阀4输入为1的占空比,开关阀3输入则为u(k),此时气动人工肌肉PAM2处于充气过程,外在状态表现为压缩形式;反之,u(k)不大于0时,开关阀4占空比输入为其对应u(k)的绝对值,开关阀3输入则为0,此时气动人工肌肉PAM2处于排气过程,外在状态表现为拉伸形式。
上述ADRC控制器参数需要整定β01、β02、β03、β1、β2、b,其余参数利用经验调
参数整定的方法有高志强教授
(21) |
根据
h | r1 | h0 | β01 | β02 | β03 | β1 | β2 | b | |
---|---|---|---|---|---|---|---|---|---|
0.01 | 80 | 0.02 | 100 | 0.03 | 100 | 5 000 | 1 | 35 | 1.1 |
kP | kI | kD |
---|---|---|
260.0 | 0.1 | 2.0 |
实验条件为气源压力0.5 MPa、连杆负载质量3 kg时,由文献[

图4 θ=20°时的阶跃响应图
Fig. 4 Step response at θ=20°
控制器 | 稳态误差/(º) | 响应时间/s |
---|---|---|
ADRC | 0.03 | 0.423 |
PID | 0.67 | 0.555 |
在上述实验条件下,气源压力与连杆负载保持不变,给定最大转角试验信号为θ为20°,最小转角试验信号θ为10°,频率为0.5 Hz的方波信号,跟踪曲线如

图5 ADRC跟踪0.5 Hz的方波信号图
Fig. 5 ADRC tracking square wave signal at 0.5 Hz

图6 PID跟踪0.5 Hz的方波信号图
Fig. 6 PID tracking square wave signal at 0.5 Hz

图7 ADRC跟踪0.5 Hz的方波信号误差图
Fig. 7 ADRC tracking square wave signal error at 0.5 Hz

图8 PID跟踪0.5 Hz的方波信号误差图
Fig. 8 PID tracking square wave signal error at 0.5 Hz
控制器 | 输入信号频率/Hz | 均方根误差/(º) | 平均绝对误差/(º) |
---|---|---|---|
ADRC | 0.5 | 3.441 | 1.674 |
PID | 0.5 | 3.984 | 2.562 |
如
给定系统输入0.5 Hz的正弦信号,此信号规律可表示为θ=10sin(πt)+15,系统跟踪信号图及相应控制器输出控制量曲线、误差曲线如图

图9 ADRC跟踪0.5 Hz的正弦信号图
Fig. 9 ADRC tracking sinusoidal signal at 0.5 Hz

图10 ADRC跟踪0.5 Hz的正弦信号误差图
Fig. 10 ADRC tracking sinusoidal signal error at 0.5 Hz

图11 PID跟踪0.5 Hz的正弦信号图
Fig. 11 PID tracking sinusoidal signal at 0.5 Hz

图12 PID跟踪0.5 Hz的正弦信号误差图
Fig. 12 PID tracking sinusoidal signal error at 0.5 Hz
控制器 | 输入信号频率/Hz | 均方根误差/(º) | 峰值最大误差/(º) | 平均绝对误差/(º) |
---|---|---|---|---|
ADRC | 0.5 | 1.323 | 2.814 | 0.664 |
PID | 0.5 | 1.456 | 3.471 | 0.734 |
如
下肢康复机器人关节驱动采用的气动肌肉具有强非线性和回滞特性,且系统参数难以准确确定,导致难以实现准确的控制。针对这一难题,笔者搭建了基于高速开关阀驱动气动人工肌肉PAM位置的伺服控制实验平台,建立系统的数学模型;在此基础上提出了不依赖于精确模型的自抗扰控制方法。该方法通过扩张状态观测器对系统总扰动进行估计,通过气动肌肉占空比的非线性约束来实现误差反馈对扰动进行补偿,得到控制规律,进行参数整定。通过ADRC和PID两种控制方法的轨迹跟踪试验证明,文中的自抗扰方法可以使得气动人工肌肉的位置控制误差更小并拥有更快速的响应速度,满足气动人工肌肉在下肢康复机器人等应用的控制要求。如果将驱动气动人工肌肉的高速开关阀换成伺服阀或比例阀,采用类似的自抗扰方法,关节位置控制精度有望得到进一步的提升。
参考文献
刘延斌, 庞翔元, 张彦斌, 等. 踝关节康复机器人主动训练柔顺控制研究[J]. 系统仿真学报, 2020, 32(1): 54-60. [百度学术]
Liu Y B, Pang X Y, Zhang Y B, et al. Research on active training compliance control of ankle rehabilitation robot[J]. Journal of System Simulation, 2020, 32(1): 54-60.(in Chinese) [百度学术]
王斌锐, 周唯逸, 许宏. 智能气动肌肉的静态驱动特性研究[J]. 农业机械学报, 2009, 40(3): 208-212, 193. [百度学术]
Wang B R, Zhou W Y, Xu H. Static actuating characteristics of intelligent pneumatic muscle[J]. Transactions of the Chinese Society for Agricultural Machinery, 2009, 40(3): 208-212, 193.(in Chinese) [百度学术]
杨玉贵, 彭光正, 王涛, 等. 具有固定重力补偿的模糊免疫PD控制在气动人工肌肉驱动机械手位置控制中的应用[J]. 机器人, 2008, 30(3): 259-263. [百度学术]
Yang Y G, Peng G Z, Wang T, et al. Application of fuzzy immune PD controller with fixed gravity compensation to displacement control for manipulator actuated by pneumatic muscle actuator[J]. Robot, 2008, 30(3): 259-263.(in Chinese) [百度学术]
张云, 郭振武, 陈迪剑, 等. 基于Kimura振荡器和虚拟模型的气动肌肉四足机器人步态控制[J]. 兵工学报, 2018, 39(7): 1411-1418. [百度学术]
Zhang Y, Guo Z W, Chen D J, et al. Gait control of quadruped robot driven by pneumatic muscle based on kimura oscillator and virtual model[J]. Acta Armamentarii, 2018, 39(7): 1411-1418. (in Chinese) [百度学术]
Zhang D H, Zhao X G, Han J D. Active model-based control for pneumatic artificial muscle[J]. IEEE Transactions on Industrial Electronics, 2017, 64(2): 1686-1695. [百度学术]
王斌锐, 张斌, 沈国阳, 等. 级联气动肌肉仿人肘关节建模与模糊控制[J]. 机器人, 2017, 39(4): 474-480. [百度学术]
Wang B R, Zhang B, Shen G Y, et al. Modeling and fuzzy control of humanoid elbow driven by cascaded pneumatic muscles[J]. Robot, 2017, 39(4): 474-480.(in Chinese) [百度学术]
Zhao X G, Ma H Y, Ye D, et al. Independent stiffness and force control of antagonistic pneumatic artificial muscles joint[C]// International Conference on Advanced Robotics and Mechatronics.IEEE, 2017:734-739. [百度学术]
龚道雄, 何睿, 于建均, 等. 一种气动肌肉拮抗驱动机器人关节的类人运动控制方法[J]. 机器人, 2019, 41(6): 803-812. [百度学术]
Gong D X, He R, Yu J J, et al. A human-like motion control method for robotic joint actuated by antagonistic pneumatic muscles[J]. Robot, 2019, 41(6): 803-812.(in Chinese) [百度学术]
Hao L N, Yang H, Sun Z Y, et al. Modeling and compensation control of asymmetric hysteresis in a pneumatic artificial muscle[J]. Journal of Intelligent Material Systems and Structures, 2017, 28(19): 2769-2780. [百度学术]
Tondu B, Ippolito S, Guiochet J, et al. A seven-degrees-of-freedom robot-arm driven by pneumatic artificial muscles for humanoid robots[J]. The International Journal of Robotics Research, 2005, 24(4): 257-274. [百度学术]
Zhu X C, Tao G L, Yao B, et al. Adaptive robust posture control of parallel manipulator driven by pneumatic muscles with redundancy[J]. IEEE/ASME Transactions on Mechatronics, 2008, 13(4): 441-450. [百度学术]
Gao Z Q. From linear to nonlinear control means: a practical progression[J]. ISA Transactions, 2002, 41(2):177-189. [百度学术]
韩京清.自抗扰控制技术:估计补偿不确定因素的控制技术[M].北京:国防工业出版社, 2008. [百度学术]
Han J Q. Active disturbance rejection control technology: control technology for estimating and compensating uncertain factors[M]. Beijing: National Defense Industry Press, 2008.(in Chinese) [百度学术]
Gao Z Q. Scaling and bandwidth-parameterization based controller tuning[C] //Proceedings of the American Control Conference. New York: IEEE, 2003: 4989-4996. [百度学术]
Fu C F, Tan W. A new method to tune linear active disturbance rejection controller[C]//2016 American Control Conference (ACC). Boston: IEEE, 2016: 1560-1565. [百度学术]