CN106074086A - 一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法 - Google Patents
一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法 Download PDFInfo
- Publication number
- CN106074086A CN106074086A CN201610424740.7A CN201610424740A CN106074086A CN 106074086 A CN106074086 A CN 106074086A CN 201610424740 A CN201610424740 A CN 201610424740A CN 106074086 A CN106074086 A CN 106074086A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- driver
- theta
- fuzzy
- formula
- 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.)
- Granted
Links
- 210000004394 hip joint Anatomy 0.000 title claims abstract description 56
- 230000035876 healing Effects 0.000 title claims abstract description 41
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000012549 training Methods 0.000 claims abstract description 33
- 238000013461 design Methods 0.000 claims abstract description 30
- 230000003044 adaptive effect Effects 0.000 claims abstract description 11
- 101000911772 Homo sapiens Hsc70-interacting protein Proteins 0.000 claims abstract description 7
- 230000008569 process Effects 0.000 claims abstract description 6
- 230000035790 physiological processes and functions Effects 0.000 claims abstract description 4
- 238000006073 displacement reaction Methods 0.000 claims description 15
- 238000013459 approach Methods 0.000 claims description 6
- 238000005452 bending Methods 0.000 claims description 6
- 230000007306 turnover Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000000694 effects Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 claims description 2
- 241000208340 Araliaceae Species 0.000 claims 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 claims 1
- 235000003140 Panax quinquefolius Nutrition 0.000 claims 1
- 235000008434 ginseng Nutrition 0.000 claims 1
- 230000008859 change Effects 0.000 abstract description 3
- 238000005516 engineering process Methods 0.000 abstract description 3
- 210000001624 hip Anatomy 0.000 description 5
- 230000001276 controlling effect Effects 0.000 description 3
- 206010008190 Cerebrovascular accident Diseases 0.000 description 2
- 241000209094 Oryza Species 0.000 description 2
- 235000007164 Oryza sativa Nutrition 0.000 description 2
- 208000006011 Stroke Diseases 0.000 description 2
- 230000033228 biological regulation Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 210000001503 joint Anatomy 0.000 description 2
- 210000003141 lower extremity Anatomy 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 235000009566 rice Nutrition 0.000 description 2
- 208000020431 spinal cord injury Diseases 0.000 description 2
- 230000001225 therapeutic effect Effects 0.000 description 2
- 241000775914 Valdivia <angiosperm> Species 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 230000003416 augmentation Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000002490 cerebral effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000006378 damage Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 210000003414 extremity Anatomy 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000037231 joint health Effects 0.000 description 1
- 229940074869 marquis Drugs 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 201000008482 osteoarthritis Diseases 0.000 description 1
- 231100000915 pathological change Toxicity 0.000 description 1
- 230000036285 pathological change Effects 0.000 description 1
- VBUNOIXRZNJNAD-UHFFFAOYSA-N ponazuril Chemical compound CC1=CC(N2C(N(C)C(=O)NC2=O)=O)=CC=C1OC1=CC=C(S(=O)(=O)C(F)(F)F)C=C1 VBUNOIXRZNJNAD-UHFFFAOYSA-N 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000002560 therapeutic procedure Methods 0.000 description 1
- 230000008733 trauma Effects 0.000 description 1
Classifications
-
- 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
- A61H1/00—Apparatus for passive exercising; Vibrating apparatus; Chiropractic devices, e.g. body impacting devices, external devices for briefly extending or aligning unbroken bones
- A61H1/02—Stretching or bending or torsioning apparatus for exercising
- A61H1/0237—Stretching or bending or torsioning apparatus for exercising for the lower limbs
- A61H1/0244—Hip
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B23/00—Exercising apparatus specially adapted for particular parts of the body
- A63B23/035—Exercising apparatus specially adapted for particular parts of the body for limbs, i.e. upper or lower limbs, e.g. simultaneously
- A63B23/04—Exercising apparatus specially adapted for particular parts of the body for limbs, i.e. upper or lower limbs, e.g. simultaneously for lower limbs
- A63B23/0482—Exercising apparatus specially adapted for particular parts of the body for limbs, i.e. upper or lower limbs, e.g. simultaneously for lower limbs primarily by articulating the hip joints
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0265—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
- G05B13/0275—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using fuzzy logic only
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
-
- 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/12—Driving means
- A61H2201/1207—Driving means with electric or magnetic drive
- A61H2201/1215—Rotary drive
-
- 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/14—Special force transmission means, i.e. between the driving means and the interface with the user
-
- 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
-
- 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
- A61H2205/00—Devices for specific parts of the body
- A61H2205/08—Trunk
- A61H2205/088—Hip
Landscapes
- Health & Medical Sciences (AREA)
- Engineering & Computer Science (AREA)
- Artificial Intelligence (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- Medical Informatics (AREA)
- Automation & Control Theory (AREA)
- Physical Education & Sports Medicine (AREA)
- General Physics & Mathematics (AREA)
- General Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Mathematical Physics (AREA)
- Fuzzy Systems (AREA)
- Epidemiology (AREA)
- Pain & Pain Management (AREA)
- Rehabilitation Therapy (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Steroid Compounds (AREA)
- Feedback Control In General (AREA)
Abstract
本发明属于自动控制技术领域,涉及一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法。本发明在模型参数存在不确定性的情况下,为使髋关节康复机器人能够保证对患者在适当的速度下进行康复训练设计了自适应控制律,其主要步骤为:(1)根据人体髋关节生理机能,设计康复训练的期望跟踪轨迹;(2)根据康复训练的期望跟踪轨迹,限定在动态过程中各驱动器的输出变化范围;(3)给出动力学方程中的未知函数和未知控制增益的界函数;(4)计算轨迹跟踪误差以及速度跟踪误差;(5)利用分层模糊逻辑系统和模糊逻辑系统设计控制律。该方法具有安全可靠、控制精度高和实时性好的优点。
Description
技术领域
本发明涉及自动控制技术领域,具体涉及一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法。
背景技术
近年,随着社会老龄化的加剧,由中风、脊髓损伤、脑外伤等原因造成的肢体残障人口迅速增加。然而,我国现有康复医疗资源紧缺,国内普遍采用的康复治疗方法存在人员消耗大、康复周期长等问题。康复机器人与智能辅助系统的研发有望有效缓解康复医疗资源供需矛盾。
髋关节是人体中承上启下的重要骨关节,它是多轴性关节,能做屈伸、收展、旋转运动。若髋关节发生病变,髋的内旋和屈伸活动就会受到限制。除髋关节本身的损伤之外,患过中风、脊椎损伤以及经过某些外科手术的病人也往往需要进行必要的髋关节康复医疗。尽管人们在机器人辅助康复训练的研究与推广方面已取得了许多成果,然而,正如文献“康复机器人的同步主动交互控制与实现”(见《自动化学报》,2015年第11期,作者:彭亮,侯增广,王卫群)所述:相对于人工方式,其康复效果并没有显著提高;除了平台本身不够完善之外,更重要的是缺乏针对康复机器人的控制方法。
新近,文献“HipBot—The design,development and control of a therapeuticrobot for hip rehabilitation”(见《Mechatronics》,2015年第30卷,作者:C.H.Guzmán-Valdivia,等)结合人体髋关节生物动力学特点设计了一种结构简单的机电一体化髋关节康复机器人,并给出了PID控制方法。这种康复机器人能够执行内收/外展以及屈/伸这些髋关节最重要的康复运动训练任务;该机器人含有1个主动转动关节和4个主动移动关节,转动关节用来实现内收/外展活动,移动关节用来实现屈/伸运动,机器人底部装配1个旋转驱动器和4个线性驱动器构成机电一体化系统;供病人穿的含有3个内置被动关节的靴子为其终端装置;这种机器人能够分别对左、右髋关节进行康复训练,其工作原理图和驱动器的结构图见该文献中的图3。然而,所给出的控制方法需要精确的数学模型;但正如文献“不确定移动机器人编队间接自适应模糊动力学控制”(见《控制与决策》,2010年第12期,作者:吴孔逸,霍伟)所指出的那样:机器人的动力学模型通常都不是精确已知的,因此还应针对模型不确定的情况给出控制方法。此外,该文献没有考虑康复训练过程中的跟踪速度问题,如果跟踪速度过快,患者可能感到不适,甚至不安全。为解决这些问题,本发明提出了综合考虑轨迹跟踪与速度跟踪的髋关节康复机器人模糊自适应控制方法,该控制方法能保证康复者在适当的速度下进行康复训练。
发明内容
本发明的目的是基于人体髋关节活动特点,在模型参数不确定的情况下,提供一种实时性好,控制精度高,且能保证闭环系统稳定性的一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法。
实现本发明目的的技术方案是:一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法,应用于髋关节康复机器人,所述髋关节康复机器人包括1个旋转驱动器、4个线性驱动器,所述旋转驱动器用来驱动机器人的主动转动关节以训练患者髋关节的内收、外展运动,所述线性驱动器用来驱动机器人的主动移动关节以训练患者髋关节的屈、伸运动,该髋关节康复机器人轨迹与速度跟踪的自适应控制方法通过以下步骤实现:
步骤1,根据人体髋关节生理机能,设计康复训练的期望跟踪轨迹如下:
步骤1.1,为训练右髋关节的内收与外展活动能力,将髋关节康复机器人的旋转驱动器即驱动器1的期望跟踪轨迹设计为
(1)式中,t为训练时间,T1,T2,T3为内收、外展的转折时刻,T4代表完成内收、外展活动一个训练周期的时刻;诸Ti的大小根据患者的病情而定:病情越重,诸Ti越大;
将(1)式中的与互换,即得训练左髋关节的内收与外展活动能力的期望跟踪轨迹;
步骤1.2,为训练髋关节的屈、伸运动能力,将髋关节康复机器人的第i个线性驱动器即驱动器i(i=2,3,4,5)的期望跟踪轨迹设计为
(2)式中的i=2,4,5;
(2)式与(3)式中,t1,t2,t3为屈、伸的转折时刻,t4代表完成屈、伸活动一个训练周期的时刻,诸ti的大小根据患者的病情而定:病情越重,诸ti越大;诸hi>0为设计参数,视小腿所能抬起的最大高度和驱动器i的最大位移而定;
步骤2,根据康复训练的期望跟踪轨迹,限定在动态过程中各驱动器位移的变化范围;
步骤3,根据髋关节康复机器人动力学方程中未知参数的变化范围,给出其动力学方程中的未知函数f(x)的界函数fU(x)以及未知控制增益g(d3)的上界函数gU(d3)和下界函数gL(d3);即fU(x),gU(d3)和gL(d3)满足:
|f(x)|≤fU(x),0<gL(d3)≤g(d3)≤gU(d3), (4)
其中髋关节康复机器人动力学方程为
(5)式中:T为转置符号;θ为旋转驱动器的角位移,即驱动器1的输出;d2,d4,d5分别为线性驱动器2,线性驱动器4,线性驱动器5在铅直方向上的位移,即分别为驱动器2,驱动器4,驱动器5的输出;d3为线性驱动器3在水平方向上的位移,即驱动器3的输出;τ1为驱动器1的驱动力矩,是系统的输入,F2,F3,F4,F5分别为驱动器2,驱动器3,驱动器4,驱动器5的驱动力,是系统的输入;g为重力加速度;
其中,J为整个机器人的转动惯量;m2,m3,m4,m5分别为驱动器2,驱动器3,驱动器4,驱动器5的质量,wm=m2+m3;a为驱动器1的中心到机器人铅直中轴线的距离,满足2a>|d3|;并且,转动惯量J,质量m2,m3,m4,m5,距离a均为未知的正参数,但这些参数的界是已知的,且有:
J-<J<J+,a_<a<a+;
且J-,J+,a-,a+均为已知的正常数;
步骤4,计算轨迹跟踪误差:e1=θr(t)-θ,
步骤5,计算速度跟踪误差:
步骤6,给定一组正数αi和βi,并选取一组具有负实部的复数λi1,且满足λi1+αi<0,取λi2为λi1的共轭复数,再取ki1=-λi1-λi2,ki2=λi1·λi2,i=1,2,3,4,5;
步骤7,选取列向量选取矩阵并给定2阶正定对称矩阵解李雅普诺夫方程
(Ai+αiI)TPi+Pi(Ai+αiI)=-Qi, (9)
得到正定解:Pi的元素由(10)式确定:
(9)式中,I为2阶单位矩阵;
步骤8,利用分层模糊逻辑系统设计控制律τ1:
步骤8.1,用两层模糊系统来逼近f(x),的表达式为
(11)式中, d3为第1层模糊系统的输入,z1为第1层模糊系统的输出,第2层模糊系统的输入为和z1;且
其中,L1为第1层模糊系统中所含的模糊规则数目,L2为第2层模糊系统中所含的模糊规则数目,和均为模糊基函数,L1维参数列向量θf1和L2维参数列向量θf2均通过自适应律来调节;
用模糊逻辑系统来逼近g(d3),的表达式为
(12)式中,ξg(d3)=(ξg1(d3),…,ξgM(d3))T,M为模糊规则数目,ξg1(d3),…,ξgM(d3)为模糊基函数,M维参数列向量θg通过自适应律来调节;
步骤8.2,设计控制律τ1:
τ1=uc1+ur1+us1, (13)
(13)式中,uc1为模糊控制项;us1为监督控制项,ur1为误差补偿控制项,分别设计为
其中,
(16)式中:当时,当时, 为设计者取定的一个正常量;符号的含义是:当时,当时,
步骤9,利用模糊系统设计控制律Fi(i=2,3,4,5):
将控制律Fi设计为
Fi=uci+uri+usi,i=2,3,4,5; (17)
(17)式中,为模糊控制项,Mi为模糊规则数目,为模糊基函数;Mi维参数列向量θi通过自适应律来调节;usi为监督控制项,uri误差补偿控制项,uri,usi分别设计为
(18)式中,
(19)、(20)两式中:当时,当时 为设计者给定的正常量;符号的含义是:当时,当时,
本发明的有益效果是:
①首次根据人体髋关节生理特点,设计了期望的康复训练跟踪轨迹,为髋关节康复机器人的控制器设计打下了基础。
②首次针对髋关节康复机器人模型参数不确定的情况,提出了自适应控制方法,该方法控制精度高,且系统达到稳态的时间极短。
③本发明提出的控制方法综合考虑了轨迹跟踪与速度跟踪问题,从而实现了髋关节康复机器人在安全速度下的轨迹跟踪,避免了过快的速度可能给患者带来的不适。
④由于控制结构中使用了分层模糊系统,避免了处理含有多个输入变量的系统时,模糊控制器中规则数目随系统变量个数呈指数增长的问题,使规则数目大大减少,便于实时控制。
⑤本发明提出的控制方法可保证闭环系统的稳定性。
附图说明
图1为本发明实施例中驱动器1的输出θ对其期望轨迹的跟踪曲线图;
图2为本发明实施例中驱动器1的输出对其期望轨迹的跟踪速度的曲线图;
图3为本发明实施例中驱动器2的输出d2对其期望轨迹的跟踪曲线图;
图4为本发明实施例中驱动器2的输出对其期望轨迹的跟踪速度的曲线图;
图5为本发明实施例中驱动器3的输出d3对其期望轨迹的跟踪曲线图;
图6为本发明实施例中驱动器3的输出对其期望轨迹的跟踪速度的曲线图;
图7为本发明实施例中驱动器4的输出d4对其期望轨迹的跟踪曲线图;
图8为本发明实施例中驱动器4的输出对其期望轨迹的跟踪速度的曲线图;
图9为本发明实施例中驱动器5的输出d5对其期望轨迹的跟踪曲线图;
图10为本发明实施例中驱动器5的输出对其期望轨迹的跟踪速度的曲线图。
具体实施方式
为使本发明的内容和技术方案更加清楚明白,以下结合实施例对本发明进一步详细说明。
实施例:
本一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法,应用于髋关节康复机器人,所述髋关节康复机器人包括1个旋转驱动器、4个线性驱动器,所述旋转驱动器用来驱动机器人的主动转动关节以训练患者髋关节的内收、外展运动,所述线性驱动器用来驱动机器人的主动移动关节以训练患者髋关节的屈、伸运动,该髋关节康复机器人轨迹与速度跟踪的自适应控制方法通过以下步骤实现:
步骤1,根据人体髋关节生理机能,设计康复训练的期望跟踪轨迹如下:
步骤1.1,为训练右髋关节的内收与外展活动能力,将髋关节康复机器人的旋转驱动器即驱动器1的期望跟踪轨迹设计为
(1)式中,t为训练时间,T1,T2,T3为内收、外展的转折时刻,T4代表完成内收、外展活动一个训练周期的时刻;诸Ti的大小根据患者的病情而定:病情越重,诸Ti越大;
将(1)式中的与互换,即得训练左髋关节的内收与外展活动能力的期望跟踪轨迹。
在实施例中,取T1=2秒,T2=3.5秒,T3=7秒,T4=10秒;并以训练右髋关节的内收与外展活动能力为例进行仿真实验。
步骤1.2,为训练髋关节的屈、伸运动能力,将髋关节康复机器人的第i个线性驱动器即驱动器i(i=2,3,4,5)的期望跟踪轨迹设计为
(2)式中的i=2,4,5;
(2)式与(3)式中,t1,t2,t3为屈、伸的转折时刻,t4代表完成屈、伸活动一个训练周期的时刻,诸ti的大小根据患者的病情而定:病情越重,诸ti越大;诸hi>0为设计参数,视小腿所能抬起的最大高度和驱动器i的最大位移而定。
在实施例中,取t1=2秒,t2=3.5秒,t3=7秒,t4=10秒,h2=h4=0.19米,h3=0.2米,h5=0.08米。
步骤2,根据康复训练的期望跟踪轨迹,限定在动态过程中各驱动器位移的变化范围;
在实施例中,限定在动态过程中,-π/4≤θ≤π/4,-0.25≤d3≤0.05,-0.05≤di≤0.25,i=2,4,5;di的上、下限其单位均为米;及诸的变化范围分别与θ及di的变化范围相同。
步骤3,根据髋关节康复机器人动力学方程中未知参数的变化范围,给出其动力学方程中的未知函数f(x)的界函数fU(x)以及未知控制增益g(d3)的上界函数gU(d3)和下界函数gL(d3);即fU(x),gU(d3)和gL(d3)满足:
|f(x)|≤fU(x),0<gL(d3)≤g(d3)≤gU(d3), (4)
其中髋关节康复机器人动力学方程为
(5)式中:T为转置符号;θ为旋转驱动器的角位移,即驱动器1的输出;d2,d4,d5分别为线性驱动器2,线性驱动器4,线性驱动器5在铅直方向上的位移,即分别为驱动器2,驱动器4,驱动器5的输出;d3为线性驱动器3在水平方向上的位移,即驱动器3的输出;τ1为驱动器1的驱动力矩,是系统的输入,F2,F3,F4,F5分别为驱动器2,驱动器3,驱动器4,驱动器5的驱动力,是系统的输入;g为重力加速度;
其中,J为整个机器人的转动惯量;m2,m3,m4,m5分别为驱动器2,驱动器3,驱动器4,驱动器5的质量,wm=m2+m3;a为驱动器1的中心到机器人铅直中轴线的距离,满足2a>|d3|;并且,转动惯量J,质量m2,m3,m4,m5,距离a均为未知的正参数,但这些参数的界是已知的,且有:
J-<J<J+,a-<a<a+;
且J-,J+,a-,a+均为已知的正常数。
康复机器人动力学模型中的各个参数值见文献“HipBot—The design,development and control of a therapeutic robot for hip rehabilitation”(C.H.Guzmán-Valdivia,A.Blanco-Ortega,M.A.Oliver-Salazar,F.A.Gómez-Becerra.Mechatronics,2015,55-64)。
在实施例中,假设机器人动力学模型中的参数均未知,但它们的上下界是已知的;即a-=0.9a,a+=1.1a,J-=0.9J,J+=1.2J。根据(6)式和(7)式,fU(x),gU(d3)和gL(d3)分别取为
步骤4,计算轨迹跟踪误差:e1=θr(t)-θ,
步骤5,计算速度跟踪误差:
步骤6,给定一组正数αi和βi,并选取一组具有负实部的复数λi1,且满足λi1+αi<0,取λi2为λi1的共轭复数,再取ki1=-λi1-λi2,ki2=λi1·λi2,i=1,2,3,4,5。
在实施例中,取αi=0.2,β1=β2=β4=β5=20,β3=40,取此处,j为虚数单位,则ki1=1,ki2=2。
步骤7,选取列向量选取矩阵并给定2阶正定对称矩阵解李雅普诺夫方程
(Ai+αiI)TPi+Pi(Ai+αiI)=-Qi, (9)
得到正定解:Pi的元素由(10)式确定:
(9)式中,I为2阶单位矩阵;在实施例中,取则
步骤8,利用分层模糊逻辑系统设计控制律τ1:
步骤8.1,用两层模糊系统来逼近f(x),的表达式为
(11)式中, d3为第1层模糊系统的输入,z1为第1层模糊系统的输出,第2层模糊系统的输入为和z1;且
其中,L1为第1层模糊系统中所含的模糊规则数目,L2为第2层模糊系统中所含的模糊规则数目,和均为模糊基函数,其表达式分别为
均为模糊集,分别为 对应的隶属函数;L1维参数列向量θf1和L2维参数列向量θf2分别通过如下自适应律(11—1)式、(11—2)式来调节:
其中,
在以上自适应律中γf1,γf2>0都是调节增益,Mf1和Mf2是设计者取定的正数。
用模糊逻辑系统来逼近g(d3),的表达式为
(12)式中,ξg(d3)=(ξg1(d3),…,ξgM(d3))T,M为模糊规则数目,ξg1(d3),…,ξgM(d3)为模糊基函数,其表达式为 为对应于Fk的隶属函数;M维参数列向量θg通过如下自适应律(12—1)式和(12—2)式来调节:
当θg的某一分量θgi=ε时,采用
其中uc1按式(14)确定,ε>0为设计参数,由gL(d3)的值和模糊规则数目来确定;
否则,采用
其中,γg>0是调节增益,Mg是设计者取定的正数。
在实施例中,由步骤3知:的论域为[-π/4,π/4],在其上取5个模糊集合,相应的隶属函数为
在d3的论域[-0.25,0.05]上取4个模糊集合,相应的隶属函数为
在的论域[-0.25,0.05]上也取4个模糊集合,相应的隶属函数为
z1的论域为[0,1](参见文献:孙多青,霍伟.具有任意形状隶属函数的分层模糊系统逼近性能研究.控制理论与应用,2003,20(3):377-381),在其上取5个模糊集合,相应的隶属函数为
对于用来逼近g(d3)的模糊逻辑系统在d3的论域[-0.25,0.05]上也取4个模糊集合,且相应的隶属函数为
步骤8.2,设计控制律τ1:
τ1=uc1+ur1+us1, (13)
(13)式中,uc1为模糊控制项;us1为监督控制项,ur1为误差补偿控制项,分别设计为
其中,
(16)式中:当时,当时, 为设计者取定的一个正常量;符号的含义是:当时,当时,在实施例中,取
步骤9,利用模糊系统设计控制律Fi(i=2,3,4,5):
将控制律Fi设计为
Fi=uci+uri+usi,i=2,3,4,5; (17)
(17)式中,为模糊控制项,Mi为模糊规则数目,为模糊基函数,其表达式为
和分别为对应于和的隶属函数;
在实施例中,对于用于设计控制律F3的模糊系统,在d3和的论域[-0.25,0.05]上取4个模糊集合,且相应的隶属函数为对于用于设计控制律Fi(i=2,4,5)的模糊系统,在di的论域[-0.05,0.25]上取4个模糊集合,且相应的隶属函数为
在的论域[-0.05,0.25]上也取4个模糊集合,相应的隶属函数为
Mi维参数列向量θi通过如下自适应律(17—1)式来调节:
其中,γi>0是调节增益,Mi是设计者取定的正数。
usi为监督控制项,uri误差补偿控制项,uri,usi分别设计为
(18)式中,
(19)、(20)两式中:当时,当时 为设计者给定的正常量;符号的含义是:当时,当时,
取
最后,将所设计的控制律τ1即(13)式和控制律Fi(i=2,3,4,5)即(17)式施加到由(5a)式、(5b)式和(5c)式所描述的控制对象中,使系统的输出(θ(t),d2(t),d3(t),d4(t),d5(t))T能够以期望的速度跟踪给定的轨迹。
在实施例中,取Mf1=Mf2=1,ε=0.01,Mg=0.5,γf1=γf2=γg=1,γ3=1000,γi=1000000,i=2,4,5,Mi=500,i=2,3,4,5。
初始条件取为:θ(0)=0,d3(0)=0.001,di(0)=0,(i=2,4,5),θf1(0),θf2(0),θg(0),以及诸θi(0)和在(0,0.01)中随机选取。
仿真实验结果如图1至图10中的实线所示,图1中的实线是驱动器1的输出θ对其期望轨迹的跟踪曲线,图2中的实线是驱动器1的输出对其期望轨迹的跟踪速度的跟踪曲线,图3、图5、图7、图9中的实线是驱动器i(i=2,3,4,5)的输出di对其期望轨迹的跟踪曲线;图4、图6、图8、图10中的实线是驱动器i(i=2,3,4,5)的输出对其期望轨迹的跟踪速度的跟踪曲线;图1至图10中的虚线是期望的轨迹,因控制精度高,有些虚线与实线重合。仿真实验结果表明:采用本发明提出的方法,有效克服了髋关节康复机器人模型不确定性对控制精度的影响,其各个驱动器的输出在极短的时间内即达到了稳定状态,控制精度达到10–1毫米量级。
根据动力学方程特点,对驱动器1采用了两层模糊逻辑系统来设计控制律。若用传统模糊逻辑系统需要5*4*4=80条规则,而本发明所采用的两层模糊逻辑系统中模糊规则数目为(20+20)=40,减少了50%的规则数目,提高了控制的实时性。
本发明未详细说明部分则属于本领域技术人员公知常识。
Claims (1)
1.一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法,应用于髋关节康复机器人,所述髋关节康复机器人包括1个旋转驱动器、4个线性驱动器,所述旋转驱动器用来驱动机器人的主动转动关节以训练患者髋关节的内收、外展运动,所述线性驱动器用来驱动机器人的主动移动关节以训练患者髋关节的屈、伸运动,其特征在于该髋关节康复机器人轨迹与速度跟踪的自适应控制方法通过以下步骤实现:
步骤1,根据人体髋关节生理机能,设计康复训练的期望跟踪轨迹如下:
步骤1.1,为训练右髋关节的内收与外展活动能力,将髋关节康复机器人的旋转驱动器即驱动器1的期望跟踪轨迹设计为
(1)式中,t为训练时间,T1,T2,T3为内收、外展的转折时刻,T4代表完成内收、外展活动一个训练周期的时刻;诸Ti的大小根据患者的病情而定:病情越重,诸Ti越大;
将(1)式中的与互换,即得训练左髋关节的内收与外展活动能力的期望跟踪轨迹;
步骤1.2,为训练髋关节的屈、伸运动能力,将髋关节康复机器人的第i个线性驱动器即驱动器i(i=2,3,4,5)的期望跟踪轨迹设计为
(2)式中的i=2,4,5;
(2)式与(3)式中,t1,t2,t3为屈、伸的转折时刻,t4代表完成屈、伸活动一个训练周期的时刻,诸ti的大小根据患者的病情而定:病情越重,诸ti越大;诸hi>0为设计参数,视小腿所能抬起的最大高度和驱动器i的最大位移而定;
步骤2,根据康复训练的期望跟踪轨迹,限定在动态过程中各驱动器位移的变化范围;
步骤3,根据髋关节康复机器人动力学方程中未知参数的变化范围,给出其动力学方程中的未知函数f(x)的界函数fU(x)以及未知控制增益g(d3)的上界函数gU(d3)和下界函数gL(d3);即fU(x),gU(d3)和gL(d3)满足:
|f(x)|≤fU(x),0<gL(d3)≤g(d3)≤gU(d3), (4)其中髋关节康复机器人动力学方程为
(5)式中:T为转置符号;θ为旋转驱动器的角位移,即驱动器1的输出;d2,d4,d5分别为线性驱动器2,线性驱动器4,线性驱动器5在铅直方向上的位移,即分别为驱动器2,驱动器4,驱动器5的输出;d3为线性驱动器3在水平方向上的位移,即驱动器3的输出;τ1为驱动器1的驱动力矩,是系统的输入,F2,F3,F4,F5分别为驱动器2,驱动器3,驱动器4,驱动器5的驱动力,是系统的输入;g为重力加速度;
其中,J为整个机器人的转动惯量;m2,m3,m4,m5分别为驱动器2,驱动器3,驱动器4,驱动器5的质量,wm=m2+m3;a为驱动器1的中心到机器人铅直中轴线的距离,满足2a>|d3|;并且,转动惯量J,质量m2,m3,m4,m5,距离a均为未知的正参数,但这些参数的界是已知的,且有:
J-<J<J+,i=2,3,4,5;a_<a<a+;
且J-,J+,a-,a+均为已知的正常数;
步骤4,计算轨迹跟踪误差:e1=θr(t)-θ,i=2,3,4,5;
步骤5,计算速度跟踪误差:i=2,3,4,5;
步骤6,给定一组正数αi和βi,并选取一组具有负实部的复数λi1,且满足λi1+αi<0,取λi2为λi1的共轭复数,再取ki1=-λi1-λi2,ki2=λi1·λi2,i=1,2,3,4,5;
步骤7,选取列向量选取矩阵并给定2阶正定对称矩阵i=1,2,3,4,5;解李雅普诺夫方程
(Ai+αiI)TPi+Pi(Ai+αiI)=-Qi, (9)
得到正定解:Pi的元素由(10)式确定:
(9)式中,I为2阶单位矩阵;
步骤8,利用分层模糊逻辑系统设计控制律τ1:
步骤8.1,用两层模糊系统来逼近f(x),的表达式为
(11)式中, 为第1层模糊系统的输入,z1为第1层模糊系统的输出,第2层模糊系统的输入为和z1;且
其中,L1为第1层模糊系统中所含的模糊规则数目,L2为第2层模糊系统中所含的模糊规则数目,和均为模糊基函数,L1维参数列向量θf1和L2维参数列向量θf2均通过自适应律来调节;
用模糊逻辑系统来逼近g(d3),的表达式为
(12)式中,ξg(d3)=(ξg1(d3),…,ξgM(d3))T,M为模糊规则数目,ξg1(d3),…,ξgM(d3)为模糊基函数,M维参数列向量θg通过自适应律来调节;
步骤8.2,设计控制律τ1:
τ1=uc1+ur1+us1, (13)
(13)式中,uc1为模糊控制项;us1为监督控制项,ur1为误差补偿控制项,分别设计为
其中,
(16)式中:当时,当时, 为设计者取定的一个正常量;符号的含义是:当时,当时,
步骤9,利用模糊系统设计控制律Fi(i=2,3,4,5):
将控制律Fi设计为
Fi=uci+uri+usi,i=2,3,4,5; (17)
(17)式中,为模糊控制项,Mi为模糊规则数目,为模糊基函数;Mi维参数列向量θi通过自适应律来调节;usi为监督控制项,uri误差补偿控制项,uri,usi分别设计为
(18)式中,
(19)、(20)两式中:当时,当时 为设计者给定的正常量;符号的含义是:当时,当时,i=2,3,4,5。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610424740.7A CN106074086B (zh) | 2016-06-16 | 2016-06-16 | 一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610424740.7A CN106074086B (zh) | 2016-06-16 | 2016-06-16 | 一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106074086A true CN106074086A (zh) | 2016-11-09 |
CN106074086B CN106074086B (zh) | 2017-12-12 |
Family
ID=57235485
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610424740.7A Active CN106074086B (zh) | 2016-06-16 | 2016-06-16 | 一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106074086B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107479381A (zh) * | 2017-08-29 | 2017-12-15 | 沈阳工业大学 | 冗余康复步行训练机器人各轴跟踪误差最优预测控制方法 |
CN113325720A (zh) * | 2021-07-05 | 2021-08-31 | 沈阳工业大学 | 具有运动速度决策的康复训练机器人自适应跟踪控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140100828A1 (en) * | 2012-10-08 | 2014-04-10 | Honda Motor Co., Ltd. | Metrics for Description of Human Capability in Execution of Operational Tasks |
CN103750927A (zh) * | 2014-01-07 | 2014-04-30 | 杭州电子科技大学 | 下肢假肢膝关节自适应迭代学习控制方法 |
CN104698848A (zh) * | 2015-02-11 | 2015-06-10 | 电子科技大学 | 一种下肢外骨骼康复机器人康复训练的控制方法 |
US20150217448A1 (en) * | 2014-02-03 | 2015-08-06 | Disney Enterprises, Inc. | Universal balancing controller for lateral stabilization of bipedal robots in dynamic unstable environments |
CN105320138A (zh) * | 2015-11-28 | 2016-02-10 | 沈阳工业大学 | 康复训练机器人运动速度和运动轨迹同时跟踪的控制方法 |
-
2016
- 2016-06-16 CN CN201610424740.7A patent/CN106074086B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140100828A1 (en) * | 2012-10-08 | 2014-04-10 | Honda Motor Co., Ltd. | Metrics for Description of Human Capability in Execution of Operational Tasks |
CN103750927A (zh) * | 2014-01-07 | 2014-04-30 | 杭州电子科技大学 | 下肢假肢膝关节自适应迭代学习控制方法 |
US20150217448A1 (en) * | 2014-02-03 | 2015-08-06 | Disney Enterprises, Inc. | Universal balancing controller for lateral stabilization of bipedal robots in dynamic unstable environments |
CN104698848A (zh) * | 2015-02-11 | 2015-06-10 | 电子科技大学 | 一种下肢外骨骼康复机器人康复训练的控制方法 |
CN105320138A (zh) * | 2015-11-28 | 2016-02-10 | 沈阳工业大学 | 康复训练机器人运动速度和运动轨迹同时跟踪的控制方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107479381A (zh) * | 2017-08-29 | 2017-12-15 | 沈阳工业大学 | 冗余康复步行训练机器人各轴跟踪误差最优预测控制方法 |
CN113325720A (zh) * | 2021-07-05 | 2021-08-31 | 沈阳工业大学 | 具有运动速度决策的康复训练机器人自适应跟踪控制方法 |
CN113325720B (zh) * | 2021-07-05 | 2023-07-18 | 沈阳工业大学 | 具有运动速度决策的康复训练机器人自适应跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106074086B (zh) | 2017-12-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107053179A (zh) | 一种基于模糊强化学习的机械臂柔顺力控制方法 | |
CN107598897A (zh) | 一种基于人体示教的仿人机器人步态规划的方法 | |
CN108970014A (zh) | 一种适用于多个关节的进阶式康复机器人及其康复训练方法 | |
Chen et al. | Disturbance observer-based patient-cooperative control of a lower extremity rehabilitation exoskeleton | |
Tarkesh Esfahani et al. | Developing an adaptive controller for a shape memory alloy walking assistive device | |
Liu et al. | Fuzzy sliding mode control of a multi-DOF parallel robot in rehabilitation environment | |
CN106074086B (zh) | 一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法 | |
Zhong et al. | Fuzzy logic compliance adaptation for an assist-as-needed controller on the Gait Rehabilitation Exoskeleton (GAREX) | |
CN112025682B (zh) | 基于肌肉协同理论的柔性外骨骼机器人控制方法及系统 | |
Qu et al. | Research on fuzzy adaptive impedance control of lower extremity exoskeleton | |
CN114795604B (zh) | 基于非零和博弈的下肢假肢协调控制方法及系统 | |
Chen et al. | Force/position control strategy of 3-PRS ankle rehabilitation robot | |
Babaiasl et al. | Mechanical design, simulation and nonlinear control of a new exoskeleton robot for use in upper-limb rehabilitation after stroke | |
CN106897575A (zh) | 一种主动型膝上假肢的准滑模控制方法 | |
Li et al. | Variable stiffness control for SEAs in rehabilitation training | |
Zhang et al. | Experiment study of impedance control on horizontal lower limbs rehabilitation robot | |
Christou et al. | Designing personalised rehabilitation controllers using offline model-based optimisation | |
Xu et al. | Dynamic model based fuzzy-impedance interaction control for rehabilitation robots | |
Ahmadian et al. | ℒ 1 Adaptive Control Design for SRS Robot Using Gaussian Process Regression | |
Zhang et al. | Design on subsection based mix position controller for lower limb rehabilitation robot | |
Chen et al. | Step length adaptation for walking assistance | |
Zhang et al. | Fuzzy adaptive sliding mode control of lower limb exoskeleton rehabilitation robot | |
CN209019853U (zh) | 一种适用于多个关节的进阶式康复机器人 | |
CN114367977A (zh) | 一种基于rto和scfo结合的下肢康复机器人的控制方法 | |
CN105467841A (zh) | 一种类人机器人上肢运动的类神经控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |