CN109256189B - 具有模型不确定性的下肢康复外骨骼的控制方法及系统 - Google Patents
具有模型不确定性的下肢康复外骨骼的控制方法及系统 Download PDFInfo
- Publication number
- CN109256189B CN109256189B CN201811091651.0A CN201811091651A CN109256189B CN 109256189 B CN109256189 B CN 109256189B CN 201811091651 A CN201811091651 A CN 201811091651A CN 109256189 B CN109256189 B CN 109256189B
- Authority
- CN
- China
- Prior art keywords
- state
- matrix
- lower limb
- state observer
- inequality
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 210000003141 lower extremity Anatomy 0.000 title claims abstract description 55
- 238000000034 method Methods 0.000 title claims abstract description 52
- 239000011159 matrix material Substances 0.000 claims abstract description 57
- 238000005516 engineering process Methods 0.000 claims abstract description 8
- 238000013461 design Methods 0.000 claims description 15
- 210000002414 leg Anatomy 0.000 claims description 8
- 230000008569 process Effects 0.000 claims description 8
- 210000000629 knee joint Anatomy 0.000 claims description 7
- 210000002683 foot Anatomy 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000013016 damping Methods 0.000 claims description 3
- 210000003127 knee Anatomy 0.000 claims description 3
- 210000004394 hip joint Anatomy 0.000 description 5
- 230000005484 gravity Effects 0.000 description 4
- 230000033001 locomotion Effects 0.000 description 4
- 210000000689 upper leg Anatomy 0.000 description 4
- 210000001503 joint Anatomy 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 239000003638 chemical reducing agent Substances 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 2
- 230000005021 gait Effects 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000012549 training Methods 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 208000012661 Dyskinesia Diseases 0.000 description 1
- 206010019468 Hemiplegia Diseases 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 210000000544 articulatio talocruralis Anatomy 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 201000010099 disease Diseases 0.000 description 1
- 230000005283 ground state Effects 0.000 description 1
- 230000036541 health Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000474 nursing effect Effects 0.000 description 1
- 230000000149 penetrating effect Effects 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16H—HEALTHCARE INFORMATICS, i.e. INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR THE HANDLING OR PROCESSING OF MEDICAL OR HEALTHCARE DATA
- G16H20/00—ICT specially adapted for therapies or health-improving plans, e.g. for handling prescriptions, for steering therapy or for monitoring patient compliance
- G16H20/30—ICT specially adapted for therapies or health-improving plans, e.g. for handling prescriptions, for steering therapy or for monitoring patient compliance relating to physical therapies or activities, e.g. physiotherapy, acupressure or exercising
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
- A61H2003/007—Appliances for aiding patients or disabled persons to walk about secured to the patient, e.g. with belts
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5007—Control means thereof computer controlled
Landscapes
- Health & Medical Sciences (AREA)
- Epidemiology (AREA)
- Public Health (AREA)
- Physical Education & Sports Medicine (AREA)
- General Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Rehabilitation Therapy (AREA)
- Pain & Pain Management (AREA)
- Veterinary Medicine (AREA)
- Biophysics (AREA)
- Engineering & Computer Science (AREA)
- Medical Informatics (AREA)
- Primary Health Care (AREA)
- Rehabilitation Tools (AREA)
Abstract
本发明公开了一种具有模型不确定性的下肢康复外骨骼的控制方法及系统,包括:步骤1:根据物理背景建立具有模型不确定性的下肢康复外骨骼;步骤2:设计状态观测器,再基于状态观测器来设计状态反馈控制器,构成闭环控制系统;步骤3:定义Lyapunov函数,通过放缩方法消去不确定项,利用线性矩阵不等式技术证明闭环控制系统的稳定性。本申请通过Lyapunov稳定性理论和线性矩阵不等式(LMI)方法基于设计状态观测器后再设计状态反馈控制器。最后,通过物理背景数据验证了该方法的有效性。本申请在考虑到系统的状态、各关节间以及外部不确定因素影响,保证下肢康复外骨骼系统稳定。
Description
技术领域
本发明涉及下肢康复外骨骼控制技术领域,尤其涉及一种具有模型不确定性的下肢康复外骨骼的控制方法。
背景技术
随着我国经济发展和医疗水平的提高,人均寿命不断提高,随之而来的人口老龄化问题日益突出,身体机能退化和疾病容易导致严重的运动障碍,不仅影响老年人的身体健康,而且需要大量的劳动人员负担照顾、护理工作,增加了社会和患者家庭的负担。因此,安全可靠、患者易接受的康复训练与代步工具研究对老年人与下肢障碍患者的康复与锻炼具有十分重要的意义。
下肢康复外骨骼在稳定性、重复性方面有先天的优势,适宜作为养老助残设备使用。近年来,下肢康复外骨骼的控制技术一直是各国外骨骼研究领域的热点,外骨骼要求良好的穿戴性和操作舒适性,这对外骨骼的机械系统设计提出了具体的要求,下肢康复外骨骼作为辅助人进行康复运动要具有安全性、平稳性。所以,从下肢康复外骨骼着手,了解下肢外骨骼运动状态以及控制器设计至关重要,同时也要注意到不确定因素对系统的影响。
专利申请号:CN201610953616.X一种不确定性条件下的下肢外骨骼时变可靠性分析方法,通过简化下肢外骨骼模型,建立独立的髋关节、膝关节和踝关节三个关节的简化模型;并充分考虑下肢外骨骼机械结构存在的不确定性因素,建立在不确定性条件下关节角的数学模型;利用运动学正问题求解方法建立末端轨迹关于不确定条件下关节角角度的数学模型;通过运动精度分析得到在不确定条件下关节角角度和末端轨迹的均值与方差;考虑下肢外骨骼失效时序,将下肢外骨骼从髋关节到末端轨迹看作自上而下的串联系统,分析每个单元的失效概率,实现下肢外骨骼系统时变可靠性计算;结果对全面提高下肢外骨骼的设计水平具有较高的理论支撑和工程实践意义。该专利具有以下缺点:
(1)未考虑系统状态,使用状态观测器可解决此问题。(2)只对下肢外骨骼系统时变可靠性进行考虑,未涉及到对其控制器设计。
专利申请号:201711137609.3穿戴式下肢外骨骼康复机器人,涉及一种穿戴式下肢外骨骼康复机器人,髋关节组件包括电机、谐波减速器、输出轴,电机通过谐波减速器连接输出轴,输出轴上通过键与大腿组件连接,传递电机扭矩。两个大腿组件之间通过穿过背部组件的缆绳连接起来,利用行走过程中的重心变化为髋关节的屈曲伸展助力。髋关节的屈曲伸展采用电机驱动和缆绳助力,此结构既减轻了外骨骼的重量,又能将人体行走过程中重心变换的势能转换为大腿向前摆动的动能,有效的减少了能量损失,降低了电机功耗。膝关节设计为四连杆机构,保证了站立相的稳定与摆动相的灵活。膝踝联动方式使穿戴者在摆动时膝关节自然屈曲,站立时膝关节自动锁定。采用气弹簧机构为坐下-站立姿态的变换提供助力。该专利具有以下缺点:(1)未考虑系统状态,使用状态观测器可解决此问题。(2)只对下肢外骨骼系统时变可靠性进行考虑,未涉及到对其控制器设计。
(3)未考虑到各关节间以及外界不确定因素影响。
专利申请号:201810036674.5一种下肢康复外骨骼系统及其步行控制方法,涉及一种下肢康复外骨骼系统及其步行控制方法,属于医疗机器人技术领域。步行控制方法包括实时数据获取步骤、步态相位识别步骤及外骨骼控制步骤;外骨骼控制步骤包括在外骨骼的摆动腿将离地至摆动腿将着地的摆动过程中,控制其主支撑腿保持大致直立状态;并在外骨骼处于摆动腿将离地的步态相位时,且满足重心转移判据后,控制外骨骼的摆动腿进行离地摆动动作;重心转移判据为外骨骼穿戴者的上身倾角处于第一预设区间内,且其足底压力处于第二预设区间内。基于该步行控制方法,能有效地消除侧向倾覆力矩,从而确保外骨骼穿戴者的步行稳定,可广泛应用于下肢无力或偏瘫患者的康复训练。该专利具有以下缺点:(1)未考虑到各关节间以及外界不确定因素影响。(2)外骨骼腿具有摆动状态,该专利未考虑系统状态,可通过设计状态观测器解决。
发明内容
本发明要解决的技术问题是现有技术中未考虑下肢康复外骨骼系统状态,只对下肢外骨骼系统时变可靠性进行考虑的缺陷。
本发明通过以下技术方案来解决上述技术问题:
一种具有模型不确定性的下肢康复外骨骼的控制方法,包括:
步骤1:根据物理背景建立具有模型不确定性的下肢康复外骨骼;
步骤2:先设计状态观测器,再基于状态观测器来设计状态反馈控制器,构成闭环控制系统;
步骤3:定义Lyapunov函数,通过放缩方法消去不确定项,利用线性矩阵不等式技术证明闭环控制系统的稳定性。
优选的,所述步骤1中建立具有模型不确定性的下肢康复外骨骼的具体过程为:
首先建立下肢康复外骨骼模型:
∑FN=mw2r
AN-(m1+m2)sin(θ)=w2(m1L1+m2L2)
∑FT=mar
g(m1+m1)cos(θ)-AT=a(m1L1+m2L2)
∑TM=ITa
TM-g(m1L1+m2L2)cos(θ)+gm2L3sin(θ)=ITa
MM=kmi
式中:m为物体质量;r为物体中第i质点和转动轴之间的距离;L1,L2和L3是身体部分和旋转膝发动机轴质心之间的距离;m1,m2分别为腿和脚的质量;AT,AN分别是电机轴上的力的切向分量和垂直分量;TM为电机转矩;θ为膝关节转动角度;IT为总的转动惯量;a为电机轴的加速度;M,MM分别为摩擦力矩和电机扭矩;N1/N2为电动机驱动器和杆之间的扭矩的比例;km是扭矩常数;ζ是与电机的机械旋转系统相关的阻尼系数;Ea为电枢电压;kv是速度常数;R是电枢电阻;v是电源电压;
经过以下处理转化为状态空间方程:
其中,x=(x1,x2,x3)为被控对象;u(t)为输入。然后用附加的状态变量x3(t)增加该模型,该状态变量代表位置误差的积分,使得稳态误差为零;
其次,加入不确定项因素得出不确定下肢康复外骨骼模型:
其中,x(t)∈Rn为被控对象的状态向量;u(t)∈Rm为被控对象的输入向量;y(t)为系统输出;A∈Rn×n、B∈Rn×m、C∈Rq×n分别为系统矩阵、输入矩阵、输出矩阵;ΔA∈Rn×n,ΔB∈Rn×m分别为A和B的不确定项,且满足ΔA=M1F1O1,ΔB=M2F2O2;Mi、Oi为已知的定常矩阵,Fi T(t)Fi(t)≤I,(i=1,2,t≥0);假设(A,C)可观,(A,B)可控。
优选的,所述步骤2中设计状态观测器如下:
根据状态观测器,所述设计状态反馈控制器如下:
其中,K∈Rm×n为待确定的反馈增益矩阵。
优选的,所述步骤2中基于状态观测器来进行控制器的设计,设计系统的状态反馈控制器为:K∈Rm×n为待确定的反馈增益矩阵;选取Lyapunov函数为:V2(t)=xTΩx+eTPe,P∈Rn×n,Ω∈Rn×n为正定矩阵,通过李雅普诺夫第二法证明系统的稳定性,根据已知的L、P,利用线性矩阵不等式方法可以求得反馈增益矩阵K,证明所设计的控制器稳定,即保证下面消去不确定项ΔA、ΔB,转化为一个线性矩阵不等式求解问题,不等式为:
Γ11=(A-BK)TΩ+Ω(A-BK)+τ1ΩM1M1 TΩ+(τ1+τ2)ΩM2M2 TΩ+τ1 -1O1 TO1+τ2 -1KTO2 TO2K
Γ12=ΩBK
Γ22=(A-LC)TP+P(A-LC)+τ4O1 TO1+τ4 -1PM1M1 TP+τ3 -1KTO2 TO2K
从上述的不等式中很难得到矩阵Ω,K,故根据设计状态观测器所得到的L,P矩阵,再通过线性矩阵不等式求解得到反馈增益矩阵K,不等式如下:
其中,
Q3=diag[-τ1I -τ2I -τ3I -τ4I]
Q11=AT+A-KTBT-BK+τ1M1M1 T+(τ2+τ3)M2M2 T
Q22=(A-LC)TP+P(A-LC)+τ4O1 TO1。
优选的,所述步骤3中证明状态观测器的状态稳定具体为:定义观测误差为选取Lyapunov函数V1(t)=eTPe(P∈Rn×n)和线性矩阵不等式方法,求得L、P,证明其观测误差为零,及该系统状态稳定;不等式为:
本发明还提供一种具有模型不确定性的下肢康复外骨骼的控制系统,应用于上述权的控制方法,包括
模型建立模块,根据物理背景建立具有模型不确定性的下肢康复外骨骼;
设计模块,先设计状态观测器,再基于状态观测器来设计状态反馈控制器,构成闭环控制系统;
稳定性证明模块,定义Lyapunov函数,通过放缩方法消去不确定项,利用线性矩阵不等式技术证明闭环控制系统的稳定性。
本发明的优点在于:
本申请通过Lyapunov稳定性理论和线性矩阵不等式(LMI)方法基于设计状态观测器后再设计状态反馈控制器。最后,通过物理背景数据验证了该方法的有效性。本申请在考虑到系统的状态、各关节间以及外部不确定因素影响,保证下肢康复外骨骼系统稳定。
附图说明
图1下肢康复外骨骼的模型图。
图2是本发明的具有模型不确定性下肢康复外骨骼的结构图。
具体实施方式
为使对本发明的结构特征及所达成的功效有更进一步的了解与认识,用以较佳的实施例及附图配合详细的说明,说明如下:
如图1所示,图中1为AT、2为TM、3为AN、4为大腿、5为θ、6为L1、7为小腿、8为脚、9为L2、10为L3、11为m1g、12为m2g。
一种具有模型不确定性的下肢康复外骨骼的控制方法,该方法包括:
步骤1:根据物理背景建立具有模型不确定性的下肢康复外骨骼;
首先建立下肢康复外骨骼模型:
∑FN=mw2r
AN-(m1+m2)sin(θ)=w2(m1L1+m2L2)
∑FT=mar
g(m1+m1)cos(θ)-AT=a(m1L1+m2L2)
∑TM=ITa
TM-g(m1L1+m2L2)cos(θ)+gm2L3sin(θ)=ITa
MM=kmi
式中:m为物体质量;r为物体中第i质点和转动轴之间的距离;L1,L2和L3是身体部分和旋转膝发动机轴质心之间的距离;m1,m2分别为腿和脚的质量;AT,AN分别是电机轴上的力的切向分量和垂直分量;TM为电机转矩;θ为膝关节转动角度;IT为总的转动惯量;a为电机轴的加速度;M,MM分别为摩擦力矩和电机扭矩;N1/N2为电动机驱动器和杆之间的扭矩的比例;km是扭矩常数;ζ是与电机的机械旋转系统相关的阻尼系数;Ea为电枢电压;kv是速度常数;R是电枢电阻;v是电源电压。经过以下处理转化为空间状态:
其中,x=(x1,x2,x3)为被控对象;u(t)为输入。然后用附加的状态变量x3(t)增加该模型,该状态变量代表位置误差的积分,使得稳态误差为零。
其次,加入不确定项因素得出不确定下肢康复外骨骼模型:
其中,x∈Rn为被控对象的状态向量;u(t)∈Rm为被控对象的输入向量;y(t)为系统输出;A∈Rn×n、B∈Rn×m、C∈Rq×n分别为系统矩阵、输入矩阵、输出矩阵;ΔA∈Rn×n,ΔB∈Rn×m分别为A和B的不确定项,且满足ΔA=M1F1O1,ΔB=M2F2O2;Mi、Oi为已知的定常矩阵,Fi T(t)Fi(t)≤I,(i=1,2,t≥0);假设(A,C)可观,(A,B)可控。
步骤2:设计状态观测器,再基于状态观测器来设计状态反馈控制器,构成闭环控制系统;
作为本发明的优选方式之一,由于实际系统中的状态变量最终是否达到稳定未知,所述设计状态观测器如下:
根据状态观测器,所述设计状态反馈控制器如下:
其中,K∈Rm×n为待确定的反馈增益矩阵。
首先设计状态观测器,从而观测系统的实际状态稳定,定义观测误差为选取Lyapunov函数V1(t)=eTPe(P∈Rn×n)和线性矩阵不等式方法,求得L、P,证明其观测误差为零,及该系统状态稳定。不等式为:
步骤3:定义Lyapunov函数,通过放缩方法消去不确定项,利用线性矩阵不等式(LMI)技术证明闭环控制系统的稳定性。
选取Lyapunov函数为:V2(t)=xTΩx+eTPe,P∈Rn×n,Ω∈Rn×n为正定矩阵,通过李雅普诺夫第二法证明系统的稳定性,根据已知的L、P,利用线性矩阵不等式方法可以求得反馈增益矩阵K,证明所设计的控制器稳定,即保证下面消去不确定项ΔA、ΔB,转化为一个线性矩阵不等式求解问题,不等式为:
Γ11=(A-BK)TΩ+Ω(A-BK)+τ1ΩM1M1 TΩ+(τ1+τ2)ΩM2M2 TΩ+τ1 -1O1 TO1+τ2 -1KTO2 TO2K
Γ12=ΩBK
Γ22=(A-LC)TP+P(A-LC)+τ4O1 TO1+τ4 -1PM1M1 TP+τ3 -1KTO2 TO2K
从上述的不等式中很难得到矩阵Ω,K,故根据设计状态观测器所得到的L,P矩阵,再通过线性矩阵不等式求解得到反馈增益矩阵K,不等式如下:
其中,
Q3=diag[-τ1I-τ2I-τ3I-τ4I]
Q11=AT+A-KTBT-BK+τ1M1M1 T+(τ2+τ3)M2M2 T
Q22=(A-LC)TP+P(A-LC)+τ4O1 TO1
参见图1:以下结合上面给出的实例,简述本发明的控制算法:
(1)该模型中,我们考虑下肢康复外骨骼模型,设置算法参数和系统各矩阵数据;
(2)设计状态观测器,通过观测器可以将实际的状态表现出来,利用LMI方法证明误差稳定,再基于状态观测器来设计状态反馈控制器,构成闭环控制系统;
(3)定义Lyapunov函数,通过放缩方法消去不确定项,利用线性矩阵不等式(LMI)技术证明闭环控制系统的稳定性。
加入观测器的稳定性证明:
选取Lyapunov函数V1(t)=eTPe(P∈Rn×n)
2eTPΔAe≤μeTO1 TF1 TF1O1e+μ-1eTPM1M1 TPe
≤μeTO1 TO1e+μ-1eTPM1M1 TPe
控制器设计以及稳定性证明:
选取Lyapunov函数为:V2(t)=xTΩx+eTPe,P∈Rn×n,Ω∈Rn×n为正定矩阵
其中,
2xTΩΔAx≤τ1xTΩM1M1 TΩx+τ1 -1xTO1 TF1 TF1O1x
-2xTΩΔBx≤τ2xTΩM2M2 TΩx+τ2 -1xTKTO2 TF2 TF2O2Kx
2xTΩΔBKe≤τ3xTΩM2M2 TΩx+τ3 -1eTKTO2 TF2 TF2O2Ke
2eTPΔAe≤τ4eTO1 TF1 TF1O1e+τ4 -1eTPM1M1 TPe
本申请一种具有模型不确定性的下肢康复外骨骼的控制方法通过加入状态观测器可以观测下肢外骨骼实际运动的状态,然后再基于状态观测器设计可行的状态反馈控制器,从而解决不确定因素的影响的同时,观测下肢外骨骼状态及设计出合理的控制器。
以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是本发明的原理,在不脱离本发明精神和范围的前提下本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明的范围内。本发明要求的保护范围由所附的权利要求书及其等同物界定。
Claims (5)
1.一种具有模型不确定性的下肢康复外骨骼的控制方法,其特征在于,包括:
步骤1:根据物理背景建立具有模型不确定性的下肢康复外骨骼;
步骤2:先设计状态观测器,再基于状态观测器来设计状态反馈控制器,构成闭环控制系统;
步骤3:定义Lyapunov函数,通过放缩方法消去不确定项,利用线性矩阵不等式技术证明闭环控制系统的稳定性;
所述步骤1中建立具有模型不确定性的下肢康复外骨骼的具体过程为:
首先建立下肢康复外骨骼模型:
∑FN=mw2r
AN-(m1+m2)sin(θ)=w2(m1L1+m2L2)
∑FT=mar
g(m1+m1)cos(θ)-AT=a(m1L1+m2L2)
∑TM=ITa
TM-g(m1L1+m2L2)cos(θ)+gm2L3sin(θ)=ITa
MM=kmi
式中:m为物体质量;r为物体中第i质点和转动轴之间的距离;L1,L2和L3是身体部分和旋转膝发动机轴质心之间的距离;m1,m2分别为腿和脚的质量;AT,AN分别是电机轴上的力的切向分量和垂直分量;TM为电机转矩;θ为膝关节转动角度;IT为总的转动惯量;a为电机轴的加速度;M,MM分别为摩擦力矩和电机扭矩;N1/N2为电动机驱动器和杆之间的扭矩的比例;km是扭矩常数;ζ是与电机的机械旋转系统相关的阻尼系数;Ea为电枢电压;kv是速度常数;R是电枢电阻;v是电源电压;
经过以下处理转化为状态空间方程:
其中,x=(x1,x2,x3)为被控对象;u(t)为输入;然后用附加的状态变量x3(t)增加该模型,该状态变量代表位置误差的积分,使得稳态误差为零;
其次,加入不确定项因素得出不确定下肢康复外骨骼模型:
其中,x∈Rn为被控对象的状态向量;u(t)∈Rm为被控对象的输入向量;y(t)为系统输出;A∈Rn×n、B∈Rn×m、C∈Rq×n分别为系统矩阵、输入矩阵、输出矩阵;ΔA∈Rn×n,ΔB∈Rn×m分别为A和B的不确定项,且满足ΔA=M1F1O1,ΔB=M2F2O2;Mi、Oi为已知的定常矩阵,Fi T(t)Fi(t)≤I,(i=1,2,t≥0);假设(A,C)可观,(A,B)可控。
3.根据权利要求2所述的一种具有模型不确定性的下肢康复外骨骼的控制方法,其特征在于,所述步骤2中基于状态观测器来进行控制器的设计,设计系统的状态反馈控制器为:K∈Rm×n为待确定的反馈增益矩阵;选取Lyapunov函数为:V2(t)=xTΩx+eTPe,P∈Rn×n,Ω∈Rn×n为正定矩阵,通过李雅普诺夫第二法证明系统的稳定性,根据已知的L、P,利用线性矩阵不等式方法可以求得反馈增益矩阵K,证明所设计的控制器稳定,即保证下面消去不确定项ΔA、ΔB,转化为一个线性矩阵不等式求解问题,不等式为:
Γ11=(A-BK)TΩ+Ω(A-BK)+τ1ΩM1M1 TΩ+(τ1+τ2)ΩM2M2 TΩ+τ1 -1O1 TO1+τ2 -1KTO2 TO2K
Γ12=ΩBK
Γ22=(A-LC)TP+P(A-LC)+τ4O1 TO1+τ4 -1PM1M1 TP+τ3 -1KTO2 TO2K
根据设计状态观测器所得到的L,P矩阵,再通过线性矩阵不等式求解得到反馈增益矩阵K,不等式如下:
其中,
Q3=diag[-τ1I -τ2I -τ3I -τ4I]
Q11=AT+A-KTBT-BK+τ1M1M1 T+(τ2+τ3)M2M2 T
Q22=(A-LC)TP+P(A-LC)+τ4O1 TO1。
5.一种具有模型不确定性的下肢康复外骨骼的控制系统,其特征在于,应用于上述权利要求1至4 任一所述的控制方法,包括:
模型建立模块,根据物理背景建立具有模型不确定性的下肢康复外骨骼;
设计模块,先设计状态观测器,再基于状态观测器来设计状态反馈控制器,构成闭环控制系统;
稳定性证明模块,定义Lyapunov函数,通过放缩方法消去不确定项,利用线性矩阵不等式技术证明闭环控制系统的稳定性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811091651.0A CN109256189B (zh) | 2018-09-19 | 2018-09-19 | 具有模型不确定性的下肢康复外骨骼的控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811091651.0A CN109256189B (zh) | 2018-09-19 | 2018-09-19 | 具有模型不确定性的下肢康复外骨骼的控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109256189A CN109256189A (zh) | 2019-01-22 |
CN109256189B true CN109256189B (zh) | 2022-03-11 |
Family
ID=65047707
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811091651.0A Active CN109256189B (zh) | 2018-09-19 | 2018-09-19 | 具有模型不确定性的下肢康复外骨骼的控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109256189B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111755096A (zh) * | 2020-05-09 | 2020-10-09 | 深圳先进技术研究院 | 助力效能测试方法、调节方法、计算机设备以及存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104407515A (zh) * | 2014-11-13 | 2015-03-11 | 华南理工大学 | 一种基于不确定模型的LMIs状态反馈系统控制方法 |
CN104523404A (zh) * | 2009-07-01 | 2015-04-22 | 瑞克仿生学有限公司 | 助动器的控制系统 |
CN105005195A (zh) * | 2014-04-18 | 2015-10-28 | 东北大学 | 一种上肢康复机器人康复训练运动控制方法 |
CN105955033A (zh) * | 2016-07-01 | 2016-09-21 | 天津科技大学 | 一种光伏lcl型并网逆变器的控制方法 |
CN106094511A (zh) * | 2016-06-18 | 2016-11-09 | 哈尔滨理工大学 | 一种时滞lpv系统的鲁棒h∞状态反馈控制器的设计方法 |
CN106338917A (zh) * | 2016-10-26 | 2017-01-18 | 江南大学 | 一种基于状态观测器的网络化控制系统的非脆弱h∞控制方法 |
WO2018017436A1 (en) * | 2016-07-22 | 2018-01-25 | President And Fellows Of Harvard College | Controls optimization for wearable systems |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10307272B2 (en) * | 2005-03-31 | 2019-06-04 | Massachusetts Institute Of Technology | Method for using a model-based controller for a robotic leg |
EP2238894B1 (en) * | 2009-04-07 | 2011-11-02 | Syco Di Hedvig Haberl & C. S.A.S. | System for controlling an exoskeleton haptic device for rehabilitation purposes, and corresponding exoskeleton haptic device |
US9907722B2 (en) * | 2014-08-15 | 2018-03-06 | Honda Motor Co., Ltd. | Admittance shaping controller for exoskeleton assistance of the lower extremities |
-
2018
- 2018-09-19 CN CN201811091651.0A patent/CN109256189B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104523404A (zh) * | 2009-07-01 | 2015-04-22 | 瑞克仿生学有限公司 | 助动器的控制系统 |
CN105005195A (zh) * | 2014-04-18 | 2015-10-28 | 东北大学 | 一种上肢康复机器人康复训练运动控制方法 |
CN104407515A (zh) * | 2014-11-13 | 2015-03-11 | 华南理工大学 | 一种基于不确定模型的LMIs状态反馈系统控制方法 |
CN106094511A (zh) * | 2016-06-18 | 2016-11-09 | 哈尔滨理工大学 | 一种时滞lpv系统的鲁棒h∞状态反馈控制器的设计方法 |
CN105955033A (zh) * | 2016-07-01 | 2016-09-21 | 天津科技大学 | 一种光伏lcl型并网逆变器的控制方法 |
WO2018017436A1 (en) * | 2016-07-22 | 2018-01-25 | President And Fellows Of Harvard College | Controls optimization for wearable systems |
CN106338917A (zh) * | 2016-10-26 | 2017-01-18 | 江南大学 | 一种基于状态观测器的网络化控制系统的非脆弱h∞控制方法 |
Non-Patent Citations (8)
Title |
---|
Adaptive Control of an Exoskeleton Robot with Uncertainties on Kinematics and Dynamics;Brahim Brahmi 等;《2017 International Conference on Rehabilitation Robotics (ICORR)》;20170815;1369-1374 * |
Control and Design of the Lower Extremities Exoskeleton Model with Uncertainty;Jun Chen 等;《ICRAI 2018:Proceedings of the 2018 4th International Conference on Robotics and Artificial Intelligence》;20181130;76-81 * |
Drillis and Contini Revisited Using Correlation Analysis for Indonesian Adults Anthropometry;M. Hartono 等;《2015 IEEE International Conference on Industrial Engineering and Engineering Management (IEEM)》;20160121;1138-1141 * |
Model-free control using time delay estimation and fractional-order nonsingular fast terminal sliding mode for uncertain lower-limb exoskeleton;Saim Ahmed 等;《Journal od Vibration and Control》;20180107;1-18 * |
Optimized Control for Exoskeleton for Lower Limb Rehabilitation with Uncertainty;Jun Chen 等;《2019 Chinese Control And Decision Conference(CCDC)》;20190912;5121-5125 * |
下肢外骨骼系统鲁棒跟踪优化控制研究;陈军;《中国优秀硕士学位论文全文数据库 信息科技辑》;20200715(第07期);I140-406 * |
下肢康复训练机器人主动控制的研究;李峰;《中国博士学位论文全文数据库 信息科技辑》;20160315(第03期);I140-75 * |
基于最优化算法的不确定系统鲁棒跟踪控制;谭海花;《万方知识数据平台》;20100201;1-93 * |
Also Published As
Publication number | Publication date |
---|---|
CN109256189A (zh) | 2019-01-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | Design and control of the MINDWALKER exoskeleton | |
Yu et al. | Design and control of a high-torque and highly backdrivable hybrid soft exoskeleton for knee injury prevention during squatting | |
Zhu et al. | Design and validation of a torque dense, highly backdrivable powered knee-ankle orthosis | |
Aguirre-Ollinger et al. | Lower-limb exoskeleton with variable-structure series elastic actuators: Phase-synchronized force control for gait asymmetry correction | |
US10278883B2 (en) | Systems, methods, and devices for assisting walking for developmentally-delayed toddlers | |
Lu et al. | Development and learning control of a human limb with a rehabilitation exoskeleton | |
Wei et al. | Synergy-based control of assistive lower-limb exoskeletons by skill transfer | |
EP1260201B1 (en) | Gait-locomotor apparatus | |
Dollar et al. | Active orthoses for the lower-limbs: challenges and state of the art | |
Zhu et al. | Design and validation of a partial-assist knee orthosis with compact, backdrivable actuation | |
Huang et al. | Modeling and stiffness-based continuous torque control of lightweight quasi-direct-drive knee exoskeletons for versatile walking assistance | |
Joel et al. | Review on Gait Rehabilitation Training Using Human Adaptive Mechatronics System in Biomedical Engineering | |
Ronsse et al. | Oscillator-based walking assistance: A model-free approach | |
Chen et al. | Sit-to-stand and stand-to-sit assistance for paraplegic patients with CUHK-EXO exoskeleton | |
CN111248917B (zh) | 一种下肢步行训练器主动训练控制装置 | |
Johnson et al. | Development of a mobility assist for the paralyzed, amputee, and spastic patient | |
Chen et al. | Design of a lower extremity exoskeleton for motion assistance in paralyzed individuals | |
Ajayi | Modelling and control of actuated lower limb exoskeletons: a mathematical application using central pattern generators and nonlinear feedback control techniques | |
CN109256189B (zh) | 具有模型不确定性的下肢康复外骨骼的控制方法及系统 | |
Yang et al. | A centaur system for assisting human walking with load carriage | |
Nakamura et al. | Realizing model-based wearable antigravity muscles support with dynamics terms | |
Tageldeen et al. | Motion control for a multiple input rehabilitation wearable exoskeleton using fuzzy logic and PID | |
Jang et al. | Natural gait event-based level walking assistance with a robotic hip exoskeleton | |
Osiński et al. | Conception of turning module for orthotic robot | |
Deng et al. | Human-guided robotic exoskeleton cooperative walking for climbing stairs |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |