«上一篇
文章快速检索     高级检索
下一篇»
  哈尔滨工程大学学报  2018, Vol. 39 Issue (5): 927-933  DOI: 10.11990/jheu.201703046
0

引用本文  

于凌涛, 邵兆稳, 倪龙海, 等. 下肢康复机器人模糊主从控制方法[J]. 哈尔滨工程大学学报, 2018, 39(5): 927-933. DOI: 10.11990/jheu.201703046.
YU Lingtao, SHAO Zhaowen, NI Longhai, et al. Fuzzy master-slave control in a lower-limb rehabilitation robot[J]. Journal of Harbin Engineering University, 2018, 39(5): 927-933. DOI: 10.11990/jheu.201703046.

基金项目

黑龙江省自然科学基金项目(F2015034)

通信作者

于凌涛, E-mail: yulingtao@hrbeu.edu.cn

作者简介

于凌涛(1977-), 男, 副教授

文章历史

收稿日期:2017-03-14
网络出版日期:2018-03-29
下肢康复机器人模糊主从控制方法
于凌涛, 邵兆稳, 倪龙海, 汤泽旭, 李晨正, 马孝浩, 张炳早    
哈尔滨工程大学 机电工程学院, 黑龙江 哈尔滨 150001
摘要:针对偏瘫患者的康复训练问题,本文研究了一种通过患者自身健康上肢来控制对侧受损下肢的康复训练方法。利用FAB系统测量了正常行走状态下人体上肢的肩、肘关节转角和下肢的髋、膝关节转角,对测量数据进行处理后获得人体上、下肢的步态运动轨迹。将步态测量获得的平均曲线作为基准曲线,对其进行包络分析获得参考曲线。在此基础上定义输入、输出变量的模糊集合和模糊逻辑,采用模糊化方法建立上肢运动与下肢运动之间的主从映射关系。选取上肢肩、肘关节转角的部分测量数据作为输入变量,基于Matlab进行仿真验证,通过解模糊化运算获得下肢髋、膝关节转角的输出值。将仿真验证获得的下肢髋、膝关节转角的输出值与下肢运动关节转角的原始测量值进行比对,输出信号能很好地反映下肢的运动趋势,初步验证了本文所建立的上、下肢运动之间模糊主从控制方法的可行性。
关键词下肢康复机器人    步态分析    包络曲线    主从映射    模糊控制    仿真验证    
Fuzzy master-slave control in a lower-limb rehabilitation robot
YU Lingtao, SHAO Zhaowen, NI Longhai, TANG Zexu, LI Chenzheng, MA Xiaohao, ZHANG Bingzao    
College of Mechanical and Electrical Engineering, Harbin Engineering University, Harbin 150001, China
Abstract: Aiming for the rehabilitation training for patients with hemiplegia, a method of rehabilitation training based on the correlation between upper and lower extremities during normal walking was studied, in which the healthy upper limbs of a patient were used to control the patient's contralateral injured lower limbs. Based on the FAB system, the shoulder and elbow joint rotation angles of human upper limbs and the hip and knee joint rotation angles of the lower extremities were measured under normal walking conditions. Gait motion trajectories of upper and lower limbs of the human body were obtained following measurement data processing. The average curve obtained from gait measurements was taken as the datum curve, and the reference curve was obtained by envelope analysis. From these results, the fuzzy sets and fuzzy logic of the input and output variables were defined, and the master-slave mapping relationship between upper-extremity motion and lower-extremity motion was established by the fuzzification method. Partial measurement data on the upper-limb shoulder and elbow joint rotation angle were used as input variables, using Matlab for simulation verification. The output values of hip and knee joint rotation angles were acquired by the defuzzification operation. A comparison of the output value of the lower-extremity hip and the knee joint rotation angle obtained by simulation with the original measured values of the lower-extremity joint rotation angle indicates that the output signal could satisfactorily reflect the movement trend of the lower limb. The feasibility of the fuzzy master-slave control method for upper and lower limbs was preliminarily verified.
Key words: lower-limb rehabilitation robot    gait analysis    envelop curve    master-slave mapping    fuzzy control    simulation verification    

中风是世界范围内第三大主要的致死原因,并且在美国及欧洲是导致永久残疾的主要原因[1-2]。中风后的神经功能损伤经常导致轻偏瘫或一侧身体的部分麻痹,这影响了病人进行日常活动的能力,如行走、进食等。物理治疗法(包括康复)能够帮助病人恢复他们丧失的功能[3-4]。康复治疗的目的在于执行特定的运动来刺激患者的运动可塑性并因此促进运动功能恢复。运动康复是依赖于肢体的,因此受影响的肢体必须进行康复训练[5-6]

传统的步态康复治疗通常需要超过三个治疗师同时人工辅助患者的腿和躯干来进行训练。随着人口老龄化的演变、医护人员的短缺以及人们对更高质量护理的需求,这些因素刺激着康复医疗领域的技术革新[7-10]。康复机器人技术具有一系列优点,有望能够代替治疗师的体能训练工作。

目前,康复机器人主从控制主要用于远程遥操作康复训练,其康复训练模式分为上肢控制上肢[11-15]和下肢控制下肢[16]。以上两种虽然可以达到较好的康复效果,但需其他人员的辅助完成。针对该情况,通过分析正常行走时人体上、下肢运动之间具有一定的关联性,本文给出了一种新的康复训练方法,即通过主从控制用上肢来控制下肢的运动。

本文通过步态测量实验获得人体正常行走状态下肩关节、肘关节、髋关节和膝关节转角数据,由此分析和处理人体上、下肢步态运动轨迹,采用模糊化方法建立上肢手腕运动与下肢脚踝运动之间的主从映射关系,通过Matlab仿真初步验证本文所建立上、下肢运动之间模糊主从控制的可行性。

1 人体上下肢步态运动分析

人体正常行走时,上、下肢之间的运动关联性可以通过主从映射来描述。其中,上肢手腕与下肢脚踝之间的映射方式为末端对应;手部与脚部之间的映射方式为关节对应。本文只研究上肢手腕与下肢脚踝之间的末端对应的映射方法。把上肢及下肢的运动周期划分成不同阶段,使上、下肢的相应运动阶段相对应,用这种方法来建立手腕位移与脚踝位移之间的映射关系。主从控制框图如图 1所示。

Download:
图 1 主从控制框图 Fig. 1 Master and slave control block diagram
1.1 步态测量实验

本实验通过摄像机录制了5名24岁左右身高相似男性的行走录像,通过对比发现5名实验者行走动作相似,步幅差异较小,但上肢关节摆动幅度参差不齐。本文旨在设计一种由上肢到下肢的通用映射关系,通过人体高度的适应性去熟悉并适应该映射关系。通过FAB实时无线动作捕捉及力学评估系统采集单人多组实验数据。该数据来源于上述5名实验者中上肢摆动幅度适中的1名男性。步态测量实验如图 2所示。

Download:
图 2 步态测量实验图 Fig. 2 Gait measurement experiment

根据步态测量实验结果,分别采用右侧上肢肩、肘关节转角及左侧下肢髋、膝关节转角的数据用于步态运动分析。且假定对侧上肢、下肢运动与所选侧肢体的运动相差半个周期。

1.2 步态实验数据处理 1.2.1 选取步态周期

通过分析步态实验测量数据,发现肘关节转角曲线相对不规律,具有明显的毛刺。为便于数据处理,在每次实验获得的数据中选取若干组肘关节转角比较规律、毛刺较少的步态周期进行处理。数据处理过程中均采用整周期的步态数据。

人体行走时上、下肢各个关节转角波峰、波谷相距很近但并不重合。为便于选取数据,统一采用髋关节转角曲线波谷作为步态周期的分界点,并据此对各关节转角数据进行截取。

由于行走步态的随意性,各步态周期时间长度皆不相同,则其实验数据长度也不相同。为便于分析,统一将步态周期数据长度都处理为105,其相对应时间长度为1.05 s。对于数据长度大于105的步态周期,从两侧选择合适的区段每隔4个数据对称删除若干组数据;对于数据长度小于105的步态周期,从两侧选择合适的区段对称插值若干组数据。

1.2.2 平均曲线处理

对各个周期的关节转角曲线进行分析后发现,肩、膝关节转角曲线分布较集中,而肘、髋关节分布较分散。为使所建立上下肢运动主从映射关系更有针对性,从肩、肘关节转角曲线中选取6个周期,从髋、膝关节转角曲线中选取8个周期,对其进行平均化处理。处理后步态周期关节转角曲线存在首位不相等问题。对平均曲线进行了适当处理以使其首位相接并具有平滑性。

经过处理后平均曲线单周期数据长度变为104,相应时间长度变为1.04 s。截取步态周期测量曲线与处理后的平均曲线如图 3所示。

Download:
图 3 步态周期曲线及平均曲线 Fig. 3 Gait cycle curves and average curves
1.3 人体上肢、下肢步态运动轨迹

根据步态实验测量数据获得平均曲线可得人体上肢肩-肘关节转角、下肢髋-膝关节转角分布曲线,如图 4所示。

Download:
图 4 上肢及下肢关节转角分布曲线图 Fig. 4 Upper and lower limb joint angle distribution curves
2 模糊主从映射方法研究

对于上肢运动,分别以肩、肘关节转角作为横、纵坐标建立坐标系,将其数据作为主从映射的输入,记为(β1, β2)。对于下肢运动,分别以髋、膝关节转角作为横、纵坐标建立坐标系,将其数据作为主从映射的输出,记为(θ1, θ2)。两脚的着地情况作为反馈信号作用于模糊控制系统。

2.1 曲线包络方法分析

由步态实验测量数据获得的上肢肩-肘关节转角分布曲线及下肢髋-膝关节转角分布曲线分别作为输入、输出变量的基准曲线,记为S0

由基准曲线经过一定规则演化而来的曲线作为参考曲线,记为Si(i=1, 2, 3, 4)。Si是以基准曲线为基准,距离为ri的外侧(i=1, 2)或内侧(i=3, 4)包络线。

计算包络线的具体过程如下:

1) 假设待包络点为(xn, yn),该点所处时间序列前后的两个点分别为(xn-1, yn-1)和(xn+1, yn+1)。其中,n为从2~104的任意一个正整数。作如下定义:

参考直线:由点(xn-1, yn-1)和(xn+1, yn+1)所确定的直线;

目标直线:过点(xn, yn)且垂直于参考直线的直线。

2) 以待包络点(xn, yn)为圆心作半径为ri的圆,把这个圆与目标直线的两个交点作为包络点。之后再根据这两个点所处的基准曲线的内、外侧来选定其中一个作为最终的包络点。

3) 参考直线的斜率为

$ {K_{ni}} = \frac{{{y_{n + 1}} - {y_{n - 1}}}}{{{x_{n + 1}} - {x_{n - 1}}}} $ (1)

目标直线的斜率为

$ {K_n}=\left\{ \begin{array}{l} - \frac{1}{{{K_{ni}}}}, \;\;{K_{ni}} \ne 0\\ \infty \;\;\;\;\;\;\;\;{K_{ni}} = 0 \end{array} \right. $ (2)

以待包络点(xn, yn)为圆心,半径为ri的圆的方程为

$ {\left( {x - {x_n}} \right)^2} + {\left( {y - {y_n}} \right)^2} = r_i^2 $ (3)

目标直线的方程为

$ \left\{ \begin{array}{l} x = {x_n}, \;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;\;{K_{ni}} = 0\\ y - {y_n} = {K_n}\left( {x - {x_n}} \right), \;\;{K_{ni}} \ne 0 \end{array} \right. $ (4)

4) 求解以上圆与目标直线的方程组,可得相应的两个包络点的方程。假定ri>0。由方程组(3)与(4)可得两个包络点的方程:

$ \left\{ \begin{array}{l} \left\{ \begin{array}{l} {x_{na}} = {x_n}\\ {y_{na}} = {y_n} \pm {r_i} \end{array} \right., \;\;\;\;\;\;\;\;\;\;\;{K_{ni}} = 0\\ \left\{ \begin{array}{l} {x_{na}} = {x_n} \pm \frac{{{r_i}}}{{\sqrt {K_n^2 + 1} }}\\ {y_{na}} = {y_n} \pm \frac{{{K_n}{r_i}}}{{\sqrt {K_n^2 + 1} }} \end{array} \right., \;\;{K_{ni}} \ne 0 \end{array} \right. $ (5)

定义各个参考曲线所用距离r1表 1所示。据此获得的输入、输出变量的参考曲线如图 5所示。

表 1 输入、输出变量各个参考曲线所用的距离ri Tab.1 The distance used by the input and output variables for each reference curve
Download:
图 5 输入、输出变量的基准曲线及各个参考曲线 Fig. 5 Input and output variables of the reference curve and the reference curve

以上两组基准/参考曲线中,每两个点之间时间间隔是10 ms(记为Δt1)。在每两个点之间通过插值运算插入9个点,使点数目增加到原来的10倍。相应地,两点的时间间隔也缩小到1 ms(记为Δt2)。

分别以相同的时间间隔Δt2按时间顺序对输入、输出数据的基准/参考曲线上的点进行编号,编号代表着相应地的点在整个步态周期中所处的次序。分别以上、下肢运动的基准曲线和参考曲线为基础定义输入、输出变量的模糊集合。

对于某个特定的时间序列,输入、输出变量的模糊集合均是定义在相应的基准/参考曲线的点上。相应地模糊逻辑运算也是在相应时间序列所对应的点上进行的。随着时间序列的变化,输入、输出变量的模糊集合也随之变化。

对于输入变量,假设基准曲线上任意一个点为(x0, y0),输入变量都记为(xi, yi),以(xi, yi)到基准曲线上任一点(x0, y0)的最短距离ri作为自变量。输入变量的模糊集合划分情况如下:

I0:基准曲线S0两侧的区域,分别以参考曲线S1及参考曲线S3为界;

I1:参考曲线S1两侧的区域,分别以基准曲线S0及参考曲线S2为界;

I2:参考曲线S2两侧的区域,内侧以参考曲线S1为界,外侧无界;

I3:参考曲线S3两侧的区域,分别以参考曲线S4及基准曲线S0为界;

I4:参考曲线S4两侧的区域,外侧以参考曲线S3为界,内侧无界。

输出变量模糊集合Oi(i=0, 1, 2, 3, …)定义方式与输入变量类似。

基于前文分析,定义输入、输出变量的模糊集合对应关系:输入变量I0I1I2I3I4分别与输出变量O0O1O2O3O4相对应。

2.2 确定输入变量的模糊集合、时间序列及隶属度

根据前面获得的输入变量基准曲线及各个参考曲线,按不同的时间间隔对各个曲线的数据点进行编号,编号代表了每个数据点所处的时间序列。对于给定的输入变量值(β1, β2),按照如下步骤进行操作:

1) 确定输入变量(β1, β2)所属的模糊集合。

① 按较大的时间间隔Δt1=10 ms计算(β1, β2)到所有曲线上邻近步态阶段内所有数据点的距离;

② 读取(β1, β2)到每条曲线上邻近点的最短距离,求出所有这些最短距离的最小值、次最小值并读取相应的编号;

③ 根据最短距离最小值、次最小值确定(β1, β2)所属的模糊集合。

2) 确定输入变量(β1, β2)所处的时间序列。

① 读取上述最短距离最小值所对应的编号;

② 在这个编号前后确定两个小区间,找到前面最短距离最小值所对应的基准曲线或参考曲线,按照较小的时间间隔Δt2=1 ms计算(β1, β2)到该曲线的这两个小区间内所有数据点的距离;

③ 求出(β1, β2)到该曲线的这两个小区间内所有数据点距离的最小值,并读取相应的数据编号,该数据编号即为(β1, β2)所处的时间序列。

为保证步态运动的顺序,在一个步态周期内不允许时间序列减小。即:如果某一时刻输入变量所处的时间序列小于或等于上一个时刻所处的时间序列,将自动把上一时刻的时间序列值赋值给当前的时刻。

为了使步态运动的时间序列不至发生大的突变,在模糊控制系统中引入足底力信号作为反馈。足底力信号由双脚的着地情况决定。在本文中,假设双脚始终处于水平状态,以髋关节为基准,把脚踝位置较低的一只脚视为着地。

把步态运动周期的时间序列从中间划分为两个阶段。当足底力信号不发生变化时,输入变量(β1, β2)只能在当前阶段的时间序列中进行运算。只有当足底力信号发生变化时,输入变量才能在另一个步态阶段的时间序列中进行运算。

3) 确定输入变量(β1, β2)所属模糊集合的隶属度。

① 找到模糊集合中确定的最短距离最小值、次最小值所对应的基准曲线或参考曲线,按照②中确定的时间序列找到相应曲线上对应的数据点,计算(β1, β2)到这两个数据点的距离,分别记为didj

② 分别把dj/(di+dj)、di/(di+dj)作为(β1, β2)属于相应模糊集合的隶属度。

如果(β1, β2)处于参考曲线S2的外侧,则它隶属于I2的隶属度为1,隶属于其他模糊集合的隶属度均为0。如果(β1, β2)处于参考曲线S4的内侧,则它隶属于I4的隶属度为1,隶属于其他模糊集合的隶属度均为0。

2.3 输出变量的解模糊化运算

根据输入变量(β1, β2)所属的模糊集合及隶属度,按照模糊逻辑确定输出变量(θ1, θ2)所处的模糊集合及隶属度,作为后续解模糊化运算的依据。

根据输出变量(θ1, θ2)所属的模糊集合确定相应的基准曲线及参考曲线,根据(θ1, θ2)所处的时间序列在相应曲线上查找对应的数据点,根据(θ1, θ2)所属的相应模糊集合及隶属度,用重心法进行解模糊化运算。

2.4 模糊主从控制方法仿真验证

按照前几节所描述方法,通过Matlab进行仿真验证。以右侧上肢肩、肘关节转角为输入,以左侧下肢髋、膝关节转角为输出,以足底力信号作为反馈。对于右侧下肢髋、膝关节转角,按照与左侧下肢相应转角滞后半个步态周期来处理。仿真过程中,假定脚部始终保持水平,脚底水平着地。以髋关节为原点,利用两脚踝相对于髋关节的竖直位移关系来模拟足底力信号,进而用于调节(β1, β2)的运算区间。为验证主从映射方法的正确性,本文从输入信号中截取一部分进行仿真验证。仿真过程中作为输入信号的上肢肩、肘关节转角曲线如图 6所示。

Download:
图 6 上肢关节转角输入信号 Fig. 6 Upper limb joint angle input signal

输出的下肢髋、膝关节转角信号及原始髋、膝关节转角信号如图 7所示。从图中可以看出,髋关节输出曲线与原始曲线的最大误差不超过8°,两条曲线之间的误差波动不剧烈,平均误差在5.7°左右,后期通过算法补偿可以较容易的修正输出曲线以减小误差范围;膝关节两条曲线的最大误差超过10°,最小误差在1°左右,误差起伏较大,仅通过算法补偿难以有效的缩小误差范围。尽管输出信号与原始信号相比存在较大误差,但也能较好地反映下肢的运动趋势,从而基本验证了本文所提出的主从映射方法的可行性。

Download:
图 7 下肢关节转角输出信号与原始信号 Fig. 7 The output signal of the lower limb joint and the original signal
3 结论

1) 基于模糊理论的方法对人体上肢运动与下肢运动之间存在的关联建立主从映射关系,通过对Matlab仿真实验结果的分析,发现输出信号能较好地反映下肢的运动趋势,初步验证该方法的可行性。

2) 本文为现有的康复训练提供一个新的思路,该康复训练方法针对单侧肢体具有运动能力偏瘫患者,充分发掘其的康复训练潜力,不仅提高了患者参与康复训练的积极性,还在一定程度上降低康复治疗师的工作强度。

目前建立的主从映射关系存在一定的误差,在下一步工作中还需不断改进算法,减小输出误差范围。

参考文献
[1]
LLOYD-JONES D, ADAMS R J, BROWN T M, et al. Heart disease and stroke statistics-2010 update:A report from the American heart association[J]. Circulation, 2010, 121(7): e46-e215. DOI:10.1161/CIRCULATIONAHA.109.192667 (0)
[2]
ROGER VL, GO A, LLOYD-JONES D, et al. Heart disease and stroke statistics-2011 update a report from the american heart association[J]. Circulation, 2011, 123(4): e18-e209. DOI:10.1161/CIR.0b013e3182009701 (0)
[3]
侯增广, 赵新刚, 程龙, 等. 康复机器人与智能辅助系统的研究进展[J]. 自动化学报, 2016, 42(12): 1765-1779.
HOU Zengguang, ZHAO Xingang, CHENG Long, et al. Recent advances in rehabilitation robots and intelligent assistance systems[J]. Acta automatica sinica, 2016, 42(12): 1765-1779. (0)
[4]
胡进, 侯增广, 陈翼雄, 等. 下肢康复机器人及其交互控制方法[J]. 自动化学报, 2014, 40(11): 2377-2390.
HU Jin, HOU Zengguang, CHEN Yixiong, et al. Lower limb rehabilitation robots and interactive control methods[J]. Acta automatica sinica, 2014, 40(11): 2377-2390. (0)
[5]
SCHMIDT H, WERNER C, BERNHARDT R, et al. Gait rehabilitation machines based on programmable footplates[J]. Journal of neuroengineering and rehabilitation, 2007, 4: 2. DOI:10.1186/1743-0003-4-2 (0)
[6]
KRUCOFF M O, RAHIMPOUR S, SLUTZKY M W, et al. Enhancing nervous system recovery through neurobiologics, neural interface training, and neurorehabilitation[J]. Frontiers in neuroscience, 2016, 10(Pt 3). (0)
[7]
曹福成, 邢笑雪, 李元春, 等. 下肢康复机器人轨迹自适应滑模阻抗控制[J]. 吉林大学学报:(工学版), 2016, 46(5): 1602-1608.
CAO Fucheng, XING Xiaoxue, LI Yuanchun, et al. Adaptive trajectory sliding mode impedance control for lower limb rehabilitation robot[J]. Journal of Jilin University(engineering and technology edition), 2016, 46(5): 1602-1608. (0)
[8]
尹贵, 张小栋, 陈江城, 等. 下肢康复机器人按需辅助自适应控制方法[J]. 西安交通大学学报, 2017, 51(10): 39-46.
YIN Gui, ZHANG Xiaodong, CHEN Jiangcheng, et al. Approach for adaptive assistance control of lower limb rehabilitation robot according to human need[J]. Journal of Xi'an jiaotong university, 2017, 51(10): 39-46. DOI:10.7652/xjtuxb201710007 (0)
[9]
FREIVOGEL S, MEHRHOLZ J, HUSAK-SOTOMAYOR T, et al. Gait training with the newly developed 'LokoHelp'-system is feasible for non-ambulatory patients after stroke, spinal cord and brain injury. A feasibility study[J]. Brain Injury, 2008, 7-8(625): 632. (0)
[10]
REINKENSMEYER D, WYNNE J H, HARKEMA S J. A robotic tool for studying locomotor adaptation and rehabilitation[C]//Engineering in Medicine and Biology, 2002. 24th Annual Conference and the Annual Fall Meeting of the Biomedical Engineering Society EMBS/BMES Conference, 2002. Proceedings of the Second Joint. IEEE, 2002, 3: 2353-2354. (0)
[11]
PENG Qiyu, PARK H S, ZHANG Liqun. A low-cost portable tele-rehabilitation system for the treatment and assessment of the elbow deformity of stroke patients[C]//Proceedings of the 9th International Conference on Rehabilitation Robotics. Chicago, IL, USA, 2005: 149-151. (0)
[12]
GUO Shuxiang, ZHANG Wu, WEI Wei, et al. A kinematic model of an upper limb rehabilitation robot system[C]//Proceedings of 2013 IEEE International Conference on Mechatronics and Automation. Takamatsu, Japan, 2013: 968-973. (0)
[13]
CORTESE M, CEMPINI M, DEALMEIDA R P, et al. A mechatronic system for robot-mediated hand telerehabilitation[J]. IEEE/ASME transactions on mechatronics, 2015, 20(4): 1753-1764. DOI:10.1109/TMECH.2014.2353298 (0)
[14]
DUONG M D, TERASHIMA K, MIYOSHI T. A novel stable teleoperation with haptic feedback by means of impedance adjustment via arbitrary time delay environment for rehabilitation[C]//Proceedings of 2009 IEEE Control Applications, (CCA) & Intelligent Control, (ISIC). St. Petersburg, Russia, 2009: 1744-1749. (0)
[15]
COLIZZI L, LANEVE L, SAVINO N, et al. Aramis: A "virtua-mechatronic" approach for neuro-rehabilitation purposes[C]//Proceedings of the 10th IEEE International Conference on Information Technology and Applications in Biomedicine. Corfu, Greece, 2010: 1-4. (0)
[16]
SAKURAI T, SANKAI Y. Development of motion instruction system with interactive robot suit HAL[C]//Proceedings of 2009 IEEE International Conference on Robotics and Biomimetics. Guilin, China, 2009: 1141-1147. (0)