网刊加载中。。。

使用Chrome浏览器效果最佳,继续浏览,你可能不会看到最佳的展示效果,

确定继续浏览么?

复制成功,请在其他浏览器进行阅读

下肢外骨骼膝关节模糊滑模位置控制器设计

  • 李鹏杰
  • 王新蕊
  • 李小奇
  • 许国强
  • 司访
  • 张煜
  • 叶冬雨
中国兵器工业第二〇八所,北京,102202

最近更新:2021-11-08

DOI:10.6052/1672-6553-2020-101

  • 全文
  • 图表
  • 参考文献
  • 作者
  • 出版信息
EN
目录contents

摘要

针对下肢助力外骨骼膝关节位置伺服系统运动过程中伺服精度要求高、冲击力矩大、负载变化范围广等特点,提出了一种运用模糊规则调节的位置伺服系统滑模控制策略.该策略设计了一种新型带有积分项的滑模面模糊调节部分的结构为单输入双输出,选用模糊规则调节新型终端滑模型趋近率来抑制滑模抖振.仿真及实验表明,该控制策略稳定性和伺服跟踪性好,对负载干扰的鲁棒性强.

2020-08-28收到第1稿,2020-11-06收到修改稿.

引言

下肢助力型外骨骼系统是一种穿戴于人体的助力装置,目前主要运用于单兵,以提高士兵的物资搬运携行及快速机动能力.为贴合实战提高穿戴舒适性,下肢助力外骨骼膝关节需具有贴合人体、结构简单等特点,无法安装力矩传感器,因此大多采用位置环控制.在人机系统行走步态周期内,外骨骼膝关节面临负载冲击大、变化范围广等困难,一般控制算法难以达到理想的控制效果.滑模控制是一种变结构控制,拥有随时开关的特点,可以进行设计且对象与扰动无关,响应速度快、对参数变化及扰动不灵敏、物理实现简单,从而为复杂机电系统控制提供了一种较好的解决方案.但是当系统阶数较大或者结构参数不确定时,很难直接获取控制率,同时抖振问题一直制约着滑模控制的工程化运用.针对上述问题,国内外专家学者提出了很多解决方案,主要有趋近率法、边界层法、观测器法和与智能算法结合等.胡飞

1设计了一种模糊PID滑模控制系统,有效解决了下肢外骨骼步态控制过程中电液伺服系统存在的非线性、外在干扰等问题.宋胜利2提出一种快速二阶终端滑模控制策略,将绝对值函数隐藏在积分项里,提高了传统二阶终端滑模控制的全局收敛性.熊少峰3提出一种非奇异终端滑模方法,有效克服了奇异问题.Utkin V I4在控制率中引入等效控制来预估外界干扰.Elmokadem T5基于super twisting算法设计的二阶滑模观测器能够快速稳定估计出外界干扰,从而削弱抖振.上述研究大多采用传统趋近率和滑模面,很难实现系统快速性和稳定性的统一.

本文针对下肢助力外骨骼膝关节,设计了一种自适应滑模位置控制器,采用单输入双输出的结构形态,被控对象的输入量应用快速终端趋近率求取,选择滑模函数S作为模糊控制器的输入项,分别选择幂级趋近项系数k1和指数趋近项系数k2作为模糊控制器的两个输出项,依据系统运动动态特性与两个输出项之间的关系,制定模糊规则,使得系统状态点远离滑模面时,趋近率大,离滑模面近时,趋近率小,保证系统最大程度抑制抖振的同时快速趋近滑模面.

1 下肢助力外骨骼膝关节结构及数学模型

1.1 膝关节结构及永磁同步电机数学模型

图1给出了下肢助力外骨骼膝关节结构图,系统主要由永磁同步电机、减速器、编码器、驱动器等部件组成.为提高控制精度,系统采用三闭环控制,其中电流环和速度环采用数字控制,位置环的反馈值取执行机构轴端编码器值.

图1 膝关节系统结构图

Fig.1 An illustration of knee joint system

在不影响控制性能的情况下,假设:涡流和磁滞损耗几乎为零,电机铁芯饱和忽略不计,电机气隙磁场皆均匀分布,三相绕组的感应电流均以正弦波形式作用.依据假设的情况,采用id=0的控制策略实现对转矩控制的线性化和解耦控制.基于旋转坐标轴(dq轴坐标系),可以得出系统线性状态方

6-8

diqdtdωrdt=-R/L-Pn/L1.5Pnψf/J-B/Jiqωr (1)

机械运动方程

Jdωrdt=Te-TL-Bωr (2)

电磁转矩方程

Te=1.5Pnψfiq (3)

式中,L为等效dq轴产生的电感;iqq轴上的电流;TL为折算到电机轴上的总负载转矩;R为定子相电阻;ωr为转子的机械角速度;B为黏滞摩擦系数;ψf为转子上的磁势;Te为电机轴输出转矩;J为折算到电机轴上的总转动惯量;Pn为极对个数.

1.2 膝关节伺服系统状态空间模型

膝关节伺服系统采用三闭环控制,其中位置环选用模糊滑模控制器,速度环简化为PI控制,电流环简化为P控制.由于模糊滑模控制对系统参数精度要求低,故将机械部分假设成刚性体,电气部分处于理想状态,可得速度环的传递函数

9

G(s)s=K/(1+τms) (4)

式中,τm=L/R是速度环时间常数,K是速度环增益.将减速器考虑成积分环节1/(is)i为减速比,可得膝关节伺服系统开环传递函数

10

G(s)=K1+τms1is=Ki(1+τms)s (5)

可得下肢助力外骨骼膝关节伺服系统结构图如图2所示.其中,θ为实际位置并作为反馈量,θref为指令位置,位置控制器的输出量ωref是被控对象的输入量,设u=ωref,系统的状态向量为X=[x1x2],其中x1=θx2=θ˙,则系统状态空间方程

11-13

图2 下肢助力外骨骼膝关节位置伺服系统结构简图

Fig.2 Structure diagram of knee joint position servo system of lower limb assist exoskeleton

x˙1=x2x˙2=f(x)+g(x)u (6)

式中,f(x)=-1/τmx2g(x)=K/iτm考虑系统经常受到不确定因素的影响,为提高状态空间方程精度,需增加不确定项:

x˙1=x˙2x˙2=f(x)+Δf+[g(x)+Δg]u (7)

式中ΔfΔg为添加的不确定部分,假使系统满足条件

|Δf|F 1βg+Δggβ (8)

式中, β≥1且为常数,F为标量值.

2 模糊自适应滑模控制器设计

2.1 滑模控制器设计

系统位置跟踪误差向量为:

E=Xd-X=[x1d-x1x2d-x2]T=[ee˙]T

式中,Xd=[x1dx2d]Tx1d=θrefx2d=θ˙ref .可得:

e¨=x˙2d-x˙2=f(x)+Δf+[g(x)+Δg]u-θ¨ (9)

设计带积分滑模面:

s=e˙+k3e+k40tedt (10)

式中,k3,k4为大于零的常数.可得:

s˙=e¨+k3e˙+k4e=k3e˙+k4e+f+Δf+(g+Δg)u-θ¨ (11)

滑模面选用一种快速终端滑模型趋近率:

s˙=-k1sαsgn(s)-k2s (12)

式中,k1,k2为正常数,α(0,1).由于现实系统存在空间和时间上的滞后,因此假设一种等效的平均滑模位置控制器uequ(不确定性为0),根据式(9)式(10)可得:

s˙=-k1sαsgn(s)-k2s=k3e˙+k4e+f+guequ-θ¨ (13)
uequ=-1g[k1sαsgn(s)-k2s+f+k3e˙+k4e-θ¨] (14)

将切换位置控制器设计为:

uq=-Ksgn(s)/g (15)

式中,K>0.可得总控制器为:

u=uequ+uq=-k1|s|αsgn(s)-k2s+f+k3e˙+k4e-θ¨+Ksgn(s)/gg (16)

将增益项设计为:

K=β[F+ξ+(β-1)guequ] (17)

式中,ξ>0.取李雅普诺夫函数为V=0.5s2,则有:

V˙=ss˙=s[k3e˙+k4e+f+Δf+(g+Δg)u-θ¨]=s[k3e˙+k4e+f+Δf+(g+Δg)uequ-(g+Δg)Ksgn(s)/g-θ¨] (18)

式(11)可知:

k3e˙+k4e=-k1sαsgn(s)-k2s-f-guequ+θ¨ (19)

式(19)带入式(18)可知:

V˙=s[-k1|s|αsgn(s)-k2s+Δguequ+Δf-g+ΔggKsgn(s)]=-k1|s|α+1-k2s2+Δguequs+Δfs-g+ΔggK|s|
V˙Δguequs+Δfs-g+ΔggK|s|
V˙|Δg||uequ||s|+F|s|-1βK|s|. (20)

带入K,可得:

V˙|Δg||uequ||s|+F|s|-1ββ[F+ξ+(β-1)guequ]|s|
V˙|Δg||uequ||s|-ξ|s|-(β-1)guequ|s|
V˙-ξ|s|<0. (21)

根据李雅普诺夫稳定性理论判据可知,系统能够在全局意义下趋近渐进稳

1415.

2.2 趋近率系数与滑模运动特性关系分析

式(12)两边同时乘上ek2t,可得:

d(ek2ts)dt=-k1e(1-α)k2t|ek2ts|αsgn(s) (22)

式(22)两边积分,可得式(12)的解:

s(t)=sgn(s(0))e-k2t|s(0)|1-α-k1k2e(1-α)k2t+k1k211-αt<lnk1k2|s(0)|1-α+1k2(1-α),s(0)00,tlnk1k2|s(0)|1-α+1k2(1-α)0,t0,s(0)=0 (23)

其中,s(0)s(t)t=0时的初始值.由式(23)可以得出,s(t)能够在有限的时间T内收敛到0,并且调节时间T满足下式

T(s(0))=lnk1k2|s(0)|1-α+1k2(1-α) (24)

式中,当k2=0时,式(12)将变为传统幂次趋近率:

s˙=-k1|s|αsgn(s) (25)

式(25)两边积分,可得:

s(t)=sgn(s(0))[k1(1-α)+|s(0)|1-α]11-αt<|s(0)|1-αk1(1-α),s(0)00,t|s(0)|1-αk1(1-α)0,t0,s(0)=0 (26)

式(26)可得:

T(s(0))=s(0)1-αk1(1-α) (27)

比较式(24)式(27),可得:

lnk1k2|s(0)|1-α+1k2(1-α)<|s(0)|1-αk1(1-α) (28)

可知式(12)中的“-k2s”项具有加速收敛的作用.结合传统幂次趋近率特性,可知当远离滑模面时,k1,k2均应取较大值;当接近切换面时,为抑制抖振,k1,k2应取相对较小值,整个过程中应保证k1<k2,设k2=m·k1,其中m>1.

2.3 模糊自适应滑模控制器设计

根据上述趋近率系数与滑模运动特性关系,将模糊控制器设计成单输入双输出结构形式.即:运用模糊规则,根据滑模函数s的值,自适应调整k1k2的值.将s的值归一化到区间[-1,1]上,并将s分为正大、正中、正小、几为零、负小、负中、负大等7种情况,模糊子集为{NB,NM,NS,ZO,PS,PM,PB};将系数k1k2的值归一化到区间[0,1]上,分为几为零、正小、正中、正大等4种情况,模糊子集为{ZO,PS,PM,PB};隶属度函数均选用三角函数.根据上述滑模动态特性与趋近率系数之间的关系分析结果,制定14条模糊规则,如表1所示.

表1 模糊控制器规则表
Table 1 Rule table of fuzzy controller
sk1k2
NB PM PB
NM PS PB
NS PS PM
ZO ZO ZO
PS PS PM
PM PS PB
PB PM PB

采用重心法解模糊,可得:

uf(k)=Σi=1nxiμ(i)/Σi=1nμ(i) (29)

则被控对象的输入为

u=-k1sαsgn(s)-k2s+f+k3e˙+k4e-θ¨+Ksgn(s)/gg (30)

膝关节模糊自适应滑模控制系统机理如图3所示.

图3 模糊自适应滑模控制器控制机理图

Fig.3 Control mechanism of fuzzy adaptive sliding mode controller

3 仿真结果及分析

为验证控制策略的正确性,运用Matlab/Simulink进行仿真实验,并与经典PID和经典模糊自适应滑模控制策略(即:滑模面选取s=e+ce˙,其中c为常数,趋近率选取指数趋近率)相比较.仿真模型具体参数如下:模糊滑模控制器参数为c=126m=11k3=15k4=1200;电机转子惯量J=2.627gm2,等效电感L=50mL,永磁体Ψf=0.056Wb,电机磁极对数Pn=4,相间电阻R=1.38Ω,额定电流Ic=21A,摩擦黏滞系数B=1.26×10-4N·m·s;谐波减速器减速比1∶120,速度增益K=120,电流环参数为[P,I,D]=[0.715,0,0],速度环参数为[P,I,D]=[5.2×10-5,0.2884,0],位置环参数为[P,I,D]=[10000,0,0].仿真时间设置为2s,求解器选择ode45.

图4 新型滑模控制策略仿真模型

Fig.4 Simulation model of new sliding mode control strategy

3.1 常值负载干扰

为验证下肢助力外骨骼膝关节位置控制器抗干扰能力,在1s时突加一个值为10N·m的阶跃信号,如图5所示,经典PID和滑模控制器出现很大位置偏移,很长时间才恢复到平衡位置,且初始位置响应较慢;新型滑模控制器系统基本不受影响,且初始位置响应较快.

图5 阶跃响应曲线

Fig.5 Step response curve

3.2 位置跟踪误差

为验证控制系统的跟踪性能,选取r=20sin(1.24t)做为系统的跟踪曲线,如图6所示,新型滑模控制器的跟踪误差远小于经典滑模、PID控制器的跟踪误差.

图6 跟踪误差曲线

Fig.6 Tracking error curve

4 实验验证

实验系统选用STM32F407ZGT6作为位置控制核心板,电机选用J56ZWX02无刷直流电机,额定转速3058r/min~3258r/min,额定扭矩1.5N·m,谐波减速器减速比1∶120,电流环为P控制,采样频率20kHz,速度环为PI控制,执行频率10kHz,位置环依次选用经典PID控制器、经典滑模和新型滑模控制器,执行频率1kHz.系统输入选用正弦信号r=20sin(1.24t),修正参数如下:c=126m=11k3=15k4=1200.角度初值为0.08,自变量s的量化因子为0.3,变量ss˙的输出量化因子为6.3×10-73×10-7.实验结果如图7所示,与经典滑模和PID控制策略相比,新型滑模控制策略的毛刺和误差峰值明显减小.

图7 实验控制跟踪误差对比

Fig.7 Comparison of tracking error with experimental control

5 结论

针对下肢助力外骨骼膝关节位置伺服系统,设计了一种模糊自适应滑模控制策略.仿真及实验结果均表明,该控制策略与经典滑模、PID控制策略相比,跟踪误差更小、响应速度更快、鲁棒性更强,该控制策略完全能够满足下肢助力外骨骼膝关节位置环主从伺服跟踪工作要求.

参 考 文 献

1

胡飞许德章王毓.基于模糊PID滑模控制的外骨骼控制系统设计.安徽工程大学学报2017324):56~61 [百度学术

Hu FXu D ZWang Y. Design of exoskeleton control system based on fuzzy PID sliding mode control. Journal of Anhui University of Engineering2017324):56~61(in Chinese) [百度学术

2

宋胜利陈文浩张兴龙.快速二阶终端滑模控制及其在下肢外骨骼的应用. 控制与决策2019341):162~166 [百度学术

Song S LChen W HZhang X Let al. Fast second-order terminal sliding mode control and its application in lower limb exoskeleton. Control and Decision2019341):162~166(in Chinese) [百度学术

3

熊少锋王卫红王森.带攻击角度约束的非奇异快速终端滑模制导律.控制理论与应用2014313):269~278 [百度学术

Xiong S FWang W HWang S. Non-singular fast terminal sliding mode guidance law with attack angle constraint.Control Theory and Applications2014313):269~278 (in Chinese) [百度学术

4

Utkin V IPoznyak A S.Adaptive sliding mode control with application to super-twist algorithm: Equivalent control method. Automatica2013491): 39~47 [百度学术

5

Elmokadem TZribi MYoucef-Toumi K. Trajectory tracking sliding mode control of underactuated AUVs. Nonlinear Dynamics2016842): 1079~1091 [百度学术

6

李杨管小荣徐诚.基于人体步态的下肢外骨骼动力学仿真研究.南京理工大学学报(自然科学版)2015393):353~57 [百度学术

Li YGuan X RXu C. Simulation of lower limb exoskeleton dynamics based on human gait. Journal of Nanjing University of Science and Technology(Natural Science Edition)2015393):353~357(in Chinese) [百度学术

7

刘金琨.先进PID控制MATLAB仿真.北京电子工业出版社2004(Liu J K.Advanced PID control MATLAB simulation.BeijingPublishing House of Electronics Industry, 2004 (in Chinese) ) [百度学术

8

诸静.模糊控制理论与系统原理.北京机械工业出版社2005(Zhu J.Fuzzy control theory and system principle.BeijingChina Machinery Industry Press, 2005 (in Chinese)) [百度学术

9

朱蒙管小荣李杨.偏瘫下肢外骨骼结构设计与仿真分析.兵器装备工程学报20194011):160~165 [百度学术

Zhu MGuan X RLi Yet al.Design and simulation analysis of exoskeleton structure of lower limbs in hemiplegia. Ordnance Equipment Engineering Journal20194011): 160~165 (in Chinese) [百度学术

10

王险峰李建平王辉基于ZMP的仿人机器人跑步运动模式.计算机研究与发展20135010):2206~2211 [百度学术

Wang X FLi J PWang H. Running motion mode of humanoid robot based on ZMP. Computer Research and Development20135010): 2206~2211 (in Chinese) [百度学术

11

牛建凯.外骨骼机器人助力控制技术研究[硕士学位论文].北京北京理工大学2014 [百度学术

Niu J K. Research on the control technology of exoskeleton robot[Master Thesis].BeijingBeijing Institute of Technology2014(in Chinese) [百度学术

12

刘宁宁.外骨骼机器人的人-机系统平衡稳定性研究[硕士学位论文].北京北京理工大学2015 [百度学术

Liu N N.Research on the balance and stability of human-machine system of exoskeleton robot[Master Thesis]. BeijingBeijing Institute of Technology2015 (in Chinese) [百度学术

13

宋遒志王晓光王鑫.多关节外骨骼助力机器人发展现状及关键技术分析.兵工学报2016371):172~185 [百度学术

Song Q ZWang X GWang Xet al. Development status and key technology analysis of multi-joint exoskeleton assisted robots.Acta Armamentarii2016371): 172~185 (in Chinese) [百度学术

14

王峰吴志强李亚杰.多物理场仿真开关磁阻电机定子的径向电磁振动.动力学与控制学报2020184):61~69 [百度学术

Wang FWu Z QLi Y Jet al. Radial Vibration simulation of the stator in switched reluctance motor by multiphysics method. Journal of Dynamics and Control2020184):61~69 (in Chinese) [百度学术

15

张程金涛.永磁同步机变频调速系统MATLAB建模与仿真.动力学与控制学报2014122):183~187 [百度学术

Zhang CJin T. Research on modeling and simulation of PMSM variable frequency speed regulating system.Journal of Dynamics and Control2014122):183~187 (in Chinese) [百度学术

微信公众号二维码

手机版网站二维码