技术领域
本发明涉及自动控制技术领域，具体涉及一种髋关节康复机器人轨迹与速度跟踪的自适应控制方法。
背景技术
近年，随着社会老龄化的加剧，由中风、脊髓损伤、脑外伤等原因造成的肢体残障人口迅速增加。然而，我国现有康复医疗资源紧缺，国内普遍采用的康复治疗方法存在人员消耗大、康复周期长等问题。康复机器人与智能辅助系统的研发有望有效缓解康复医疗资源供需矛盾。
髋关节是人体中承上启下的重要骨关节，它是多轴性关节，能做屈伸、收展、旋转运动。若髋关节发生病变，髋的内旋和屈伸活动就会受到限制。除髋关节本身的损伤之外，患过中风、脊椎损伤以及经过某些外科手术的病人也往往需要进行必要的髋关节康复医疗。尽管人们在机器人辅助康复训练的研究与推广方面已取得了许多成果，然而，正如文献“康复机器人的同步主动交互控制与实现”(见《自动化学报》，2015年第11期，作者：彭亮，侯增广，王卫群)所述：相对于人工方式，其康复效果并没有显著提高；除了平台本身不够完善之外，更重要的是缺乏针对康复机器人的控制方法。
新近，文献“HipBot—The design,development and control of a therapeutic robot 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的期望跟踪轨迹设计为
θ r ( t ) = π 6 T 1 t , t ≤ T 1 π 6 - π 6 1 T 2 - T 1 ( t - T 1 ) , T 1 ≤ t ≤ T 2 - π 4 1 T 3 - T 2 ( t - T 2 ) , T 2 ≤ t ≤ T 3 - π 4 + π 4 1 T 4 - T 3 ( t - T 3 ) , T 3 ≤ t ≤ T 4 - - - ( 1 ) ]]>
(1)式中，t为训练时间，T1,T2,T3为内收、外展的转折时刻，T4代表完成内收、外展活动一个训练周期的时刻；诸Ti的大小根据患者的病情而定：病情越重，诸Ti越大；
将(1)式中的与互换,即得训练左髋关节的内收与外展活动能力的期望跟踪轨迹；
步骤1.2，为训练髋关节的屈、伸运动能力，将髋关节康复机器人的第i个线性驱动器即驱动器i(i＝2,3,4,5)的期望跟踪轨迹设计为
d i r ( t ) = 0 , t ≤ t 1 h i t 2 - t 1 ( t - t 1 ) , t 1 < t ≤ t 2 h i - h i t 3 - t 2 ( t - t 2 ) , t 2 < t ≤ t 3 0 , t 3 < t ≤ t 4 - - - ( 2 ) ]]>
(2)式中的i＝2,4,5；
d 3 r ( t ) = 0 , t ≤ t 1 - h 3 t 2 - t 1 ( t - t 1 ) , t 1 < t ≤ t 2 - h 3 + h 3 t 3 - t 2 ( t - t 2 ) , t 2 < t ≤ t 3 0 , t 3 < t ≤ t 4 - - - ( 3 ) ]]>
(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)
其中髋关节康复机器人动力学方程为
θ ·· = f ( x ) + g ( d 3 ) τ 1 , - - - ( 5 a ) ]]>
d ·· i = - g + b i F i , i = 2 , 4 , 5 , - - - ( 5 b ) ]]>
d ·· 3 = b 3 F 3 , - - - ( 5 c ) ]]>
(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为重力加速度；
f ( x ) = - 2 m 3 a d · 3 - 2 m 3 d · 3 2 J + w m a 2 + 2 m 3 ad 3 + m 3 d 3 2 θ · , - - - ( 6 ) ]]>
g ( d 3 ) = 1 J + w m a 2 + 2 m 3 ad 3 + m 3 d 3 2 , - - - ( 7 ) ]]>
b 2 = 1 w m , b i = 1 m i , i = 3 , 4 , 5 ; - - - ( 8 ) ]]>
其中,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)式确定：
p i 11 p i 11 p i 22 = A - 1 - q i 11 - q i 12 - q i 22 , A = 2 α i - 2 k i 2 0 1 - k i 1 + 2 α i - k i 2 0 2 - 2 k i 1 + 2 α i ; - - - ( 10 ) ]]>
(9)式中，I为2阶单位矩阵；
步骤8，利用分层模糊逻辑系统设计控制律τ1:
步骤8.1，用两层模糊系统来逼近f(x),的表达式为
f ^ ( x | θ f 2 ) = θ f 2 T ξ f 2 ( d · 3 , z 1 ) , - - - ( 11 ) ]]>
(11)式中,d3为第1层模糊系统的输入,z1为第1层模糊系统的输出,第2层模糊系统的输入为和z1；且
ξ f 1 ( θ · , d 3 ) = [ ξ f 1 1 ( θ · , d 3 ) , ... , ξ f 1 L 1 ( θ · , d 3 ) ] T , ξ f 2 ( d · 3 , z 1 ) = [ ξ f 2 1 ( d · 3 , z 1 ) , ... , ξ f 2 L 2 ( d · 3 , z 1 ) ] T , ]]>
其中，L1为第1层模糊系统中所含的模糊规则数目，L2为第2层模糊系统中所含的模糊规则数目,和均为模糊基函数,L1维参数列向量θf1和L2维参数列向量θf2均通过自适应律来调节；
用模糊逻辑系统来逼近g(d3)，的表达式为
g ^ ( d 3 | θ g ) = θ g T ξ g ( d 3 ) , - - - ( 12 ) ]]>
(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为误差补偿控制项，分别设计为
u c 1 = - f ^ ( x | θ f 2 ) - f ^ 1 ( x | θ f 1 ) + θ ·· r + k ‾ 1 T e ‾ 1 g ^ ( d 3 | θ g ) , - - - ( 14 ) ]]>
其中，
u r 1 = β 1 α 1 g L ( d 3 ) e ‾ 1 T P 1 B , - - - ( 15 ) ]]>
u s 1 = I 1 * sgn ( e ‾ 1 T P 1 B ) 1 g L ( d 3 ) [ | f ^ ( x | θ f 2 ) | + f U ( x ) + | f ^ 1 ( x | θ f 1 ) | + | g ^ ( d 3 | θ g ) u c 1 | + | g U ( d 3 ) u c 1 | ] , - - - ( 16 ) ]]>
(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分别设计为
u r i = β i α i e ‾ i T P i B , i = 2 , 3 , 4 , 5 , - - - ( 18 ) ]]>
(18)式中，
u s 3 = I 3 * sgn ( e ‾ 3 T P 3 B ) [ | u c 3 | + m 3 + | d ·· 3 r + k ‾ 3 T e ‾ 3 | ] , - - - ( 19 ) ]]>
u s i = I i * sgn ( e ‾ i T P i B ) [ | u c i | + m i + ( g + | d ·· i r + k ‾ i T e ‾ i | ) ] , i = 2 , 4 , 5 ; - - - ( 20 ) ]]>
(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的期望跟踪轨迹设计为
θ r ( t ) = π 6 T 1 t , t ≤ T 1 π 6 - π 6 1 T 2 - T 1 ( t - T 1 ) , T 1 ≤ t ≤ T 2 - π 4 1 T 3 - T 2 ( t - T 2 ) , T 2 ≤ t ≤ T 3 - π 4 + π 4 1 T 4 - T 3 ( t - T 3 ) , T 3 ≤ t ≤ T 4 - - - ( 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)的期望跟踪轨迹设计为
d i r ( t ) = 0 , t ≤ t 1 h i t 2 - t 1 ( t - t 1 ) , t 1 < t ≤ t 2 h i - h i t 3 - t 2 ( t - t 2 ) , t 2 < t ≤ t 3 0 , t 3 < t ≤ t 4 - - - ( 2 ) ]]>
(2)式中的i＝2,4,5；
d 3 r ( t ) = 0 , t ≤ t 1 - h 3 t 2 - t 1 ( t - t 1 ) , t 1 < t ≤ t 2 - h 3 + h 3 t 3 - t 2 ( t - t 2 ) , t 2 < t ≤ t 3 0 , t 3 < t ≤ t 4 - - - ( 3 ) ]]>
(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)
其中髋关节康复机器人动力学方程为
θ ·· = f ( x ) + g ( d 3 ) τ 1 , - - - ( 5 a ) ]]>
d ·· i = - g + b i F i , i = 2 , 4 , 5 , - - - ( 5 b ) ]]>
d ·· 3 = b 3 F 3 , - - - ( 5 c ) ]]>
(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为重力加速度；
f ( x ) = - 2 m 3 a d · 3 - 2 m 3 d · 3 2 J + w m a 2 + 2 m 3 ad 3 + m 3 d 3 2 θ · , - - - ( 6 ) ]]>
g ( d 3 ) = 1 J + w m a 2 + 2 m 3 ad 3 + m 3 d 3 2 , - - - ( 7 ) ]]>
b 2 = 1 w m , b i = 1 m i , i = 3 , 4 , 5 ; - - - ( 8 ) ]]>
其中,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)分别取为
f U ( x ) = 2 m 3 + a | d · 3 | + 2 m 3 + | d · 3 2 | J - + m 2 - ( a - ) 2 | θ · | , g U ( d 3 ) = 1 J - + m 2 - ( a - ) 2 , ]]>
g L ( d 3 ) = 1 J + + ( m 2 + + m 3 + ) ( a + ) 2 + 4 m 3 + ( a + ) 2 + m 3 + d 3 2 ; ]]>
步骤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)式确定：
p i 11 p i 12 p i 22 = A - 1 - q i 11 - q i 12 - q i 22 , A = 2 α i - 2 k i 2 0 1 - k i 1 + 2 α i - k i 2 0 2 - 2 k i 1 + 2 α i ; - - - ( 10 ) ]]>
(9)式中，I为2阶单位矩阵；在实施例中，取则
步骤8，利用分层模糊逻辑系统设计控制律τ1:
步骤8.1，用两层模糊系统来逼近f(x),的表达式为
f ^ ( x | θ f 2 ) = θ f 2 T ξ f 2 ( d · 3 , z 1 ) , - - - ( 11 ) ]]>
(11)式中,d3为第1层模糊系统的输入,z1为第1层模糊系统的输出,第2层模糊系统的输入为和z1；且
ξ f 1 ( θ · , d 3 ) = [ ξ f 1 1 ( θ · , d 3 ) , ... , ξ f 1 L 1 ( θ · , d 3 ) ] T , ξ f 2 ( d · 3 , z 1 ) = [ ξ f 2 1 ( d · 3 , z 1 ) , ... , ξ f 2 L 2 ( d · 3 , z 1 ) ] T , ]]>
其中，L1为第1层模糊系统中所含的模糊规则数目，L2为第2层模糊系统中所含的模糊规则数目，和均为模糊基函数，其表达式分别为
ξ f 1 l ( θ · , d 3 ) = μ A 1 l ( θ · ) μ A 2 l ( d 3 ) Σ l = 1 L 1 μ A 1 l ( θ · ) μ A 2 l ( d 3 ) , l = 1 , 2 , ... , L 1 ; ]]>
ξ f 2 n ( d · 3 , z 1 ) = μ A 3 n ( d · 3 ) μ B 1 n ( z 1 ) Σ l = 1 L 2 μ A 3 n ( d · 3 ) μ B 1 n ( z 1 ) , n = 1 , 2 , ... , L 2 ; ]]>
均为模糊集,分别为对应的隶属函数；L1维参数列向量θf1和L2维参数列向量θf2分别通过如下自适应律(11—1)式、(11—2)式来调节：
其中，
在以上自适应律中γf1,γf2＞0都是调节增益，Mf1和Mf2是设计者取定的正数。
用模糊逻辑系统来逼近g(d3)，的表达式为
g ^ ( d 3 | θ g ) = θ g T ξ g ( d 3 ) , - - - ( 12 ) ]]>
(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个模糊集合，相应的隶属函数为
μ A 1 1 ( θ · ) = exp { - ( θ · + π / 4 π / 8 ) 2 } , μ A 1 2 ( θ · ) = exp { - ( θ · + π / 8 π / 8 ) 2 } , ]]>
μ A 1 3 ( θ · ) = exp { - ( θ π / 8 ) 2 } , μ A 1 4 ( θ · ) = exp { - ( θ - π / 8 π / 8 ) 2 } , ]]>
μ A 1 5 ( θ · ) = exp { - ( θ - π / 4 π / 8 ) 2 } . ]]>
在d3的论域[-0.25,0.05]上取4个模糊集合，相应的隶属函数为
μ A 2 k ( d 3 ) = exp { - ( d 3 + 0.25 - 0.1 ( k - 1 ) 0.1 ) 2 } , k = 1 , 2 , 3 , 4 ; ]]>
在的论域[-0.25,0.05]上也取4个模糊集合，相应的隶属函数为
μ A 3 k ( d · 3 ) = exp { - ( d · 3 + 0.25 - 0.1 ( k - 1 ) 0.1 ) 2 } , k = 1 , 2 , 3 , 4 ; ]]>
z1的论域为[0,1](参见文献：孙多青,霍伟.具有任意形状隶属函数的分层模糊系统逼近性能研究.控制理论与应用,2003,20(3):377-381)，在其上取5个模糊集合,相应的隶属函数为
μ B k ( z 1 ) = exp [ - 16 ( z 1 - 0.25 ( k - 1 ) ) 2 ] , k = 1 , 2 , 3 , 4 , 5 ; ]]>
对于用来逼近g(d3)的模糊逻辑系统在d3的论域[-0.25,0.05]上也取4个模糊集合,且相应的隶属函数为
步骤8.2，设计控制律τ1：
τ1＝uc1+ur1+us1, (13)
(13)式中，uc1为模糊控制项；us1为监督控制项，ur1为误差补偿控制项，分别设计为
u c 1 = - f ^ ( x | θ f 2 ) - f ^ 1 ( x | θ f 1 ) + θ ·· r + k ‾ 1 T e ‾ 1 g ^ ( d 3 | θ g ) , - - - ( 14 ) ]]>
其中，
u r 1 = β 1 α 1 g L ( d 3 ) e ‾ 1 T P 1 B , - - - ( 15 ) ]]>
u s 1 = I 1 * sgn ( e ‾ 1 T P 1 B ) 1 g L ( d 3 ) [ | f ^ ( x | θ f 2 ) | + f U ( x ) + | f ^ 1 ( x | θ f 1 ) | + | g ^ ( d 3 | θ g ) u c 1 | + | g U ( d 3 ) u c 1 | ] , - - - ( 16 ) ]]>
(16)式中:当时,当时,为设计者取定的一个正常量；符号的含义是：当时,当时,在实施例中，取
步骤9，利用模糊系统设计控制律Fi(i＝2,3,4,5):
将控制律Fi设计为
Fi＝uci+uri+usi,i＝2,3,4,5； (17)
(17)式中，为模糊控制项，Mi为模糊规则数目,为模糊基函数,其表达式为
ξ i l ( x ‾ i ) = μ F i 1 l ( d i ) μ F i 2 l ( d · i ) Σ l = 1 M i μ F i 1 l ( d i ) μ F i 2 l ( d · i ) , i = 2 , 3 , 4 , 5 ; l = 1 , 2 , ... , M i ; ]]>
和分别为对应于和的隶属函数；
在实施例中，对于用于设计控制律F3的模糊系统,在d3和的论域[-0.25,0.05]上取4个模糊集合,且相应的隶属函数为对于用于设计控制律Fi(i＝2,4,5)的模糊系统,在di的论域[-0.05,0.25]上取4个模糊集合，且相应的隶属函数为
μ F i 1 k ( d i ) = exp { - ( d i + 0.05 - 0.1 ( k - 1 ) 0.1 ) 2 } , k = 1 , 2 , 3 , 4 ; ]]>
在的论域[-0.05,0.25]上也取4个模糊集合，相应的隶属函数为
μ F i 2 k ( d · i ) = exp { - ( d · i + 0.05 - 0.1 ( k - 1 ) 0.1 ) 2 } , k = 1 , 2 , 3 , 4. ]]>
Mi维参数列向量θi通过如下自适应律(17—1)式来调节：
其中，γi＞0是调节增益，Mi是设计者取定的正数。
usi为监督控制项，uri误差补偿控制项，uri,usi分别设计为
u r i = β i α i e ‾ i T P i B , i = 2 , 3 , 4 , 5 , - - - ( 18 ) ]]>
(18)式中，
u s 3 = I 3 * sgn ( e 3 ‾ T P 3 B ) [ | u c 3 | + m 3 + | d ·· 3 r + k ‾ 3 T e ‾ 3 | ] , - - - ( 19 ) ]]>
u s i = I i * sgn ( e ‾ i T P i B ) [ | u c i | + m i + ( g + | d ·· i r + k ‾ i T e ‾ i | ) ] , i = 2 , 4 , 5 ; - - - ( 20 ) ]]>
(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％的规则数目，提高了控制的实时性。
本发明未详细说明部分则属于本领域技术人员公知常识。