郭 盛,馬 可,王向陽
(北京交通大學(xué) 機械與電子控制工程學(xué)院,北京 100044)
調(diào)查顯示,老齡化和高強度工作導(dǎo)致勞動力人口的身體狀況不容樂觀,相關(guān)疾病的偏癱癥狀將會造成肢體殘疾.康復(fù)訓(xùn)練是使此類病人恢復(fù)自主運動的主要治療方式.傳統(tǒng)康復(fù)訓(xùn)練效率低、強度不足,因此采用機械裝置通過主動式上肢康復(fù)運動訓(xùn)練,對于增進上肢偏癱患者的肌肉活性及促進感知等方面,是一種理想的解決手段.
目前上肢康復(fù)器械種類較多,針對不同上肢關(guān)節(jié)康復(fù)已有較多研究,如北京交通大學(xué)張秀麗設(shè)計的一種基于串聯(lián)彈性驅(qū)動器的3自由度柔順機械臂[1];常州大學(xué)沈慧平等設(shè)計的一款具備單輸入三轉(zhuǎn)動輸出特性的并聯(lián)式可穿戴肩關(guān)節(jié)康復(fù)訓(xùn)練機器人[2];美國Myomo公司推出的肘關(guān)節(jié)1個自由度穿戴式腦卒中康復(fù)機器人MPower1000[3].上述機構(gòu)都只適用于局部關(guān)節(jié)康復(fù),不適用于整只手臂癱瘓患者的全面康復(fù).長安大學(xué)研制出一款可穿戴外骨骼式上肢康復(fù)訓(xùn)練機器人[4],具有3個自由度,但該機器人采用串聯(lián)結(jié)構(gòu),雖然工作空間較大,但結(jié)構(gòu)剛度低、控制誤差較大.南京理工大學(xué)研制出的一款可穿戴外骨骼式4自由度上肢康復(fù)機器[5],可滿足肩部及手肘的康復(fù)需求,但以上機構(gòu)大多是剛性體以及剛性驅(qū)動,使得患者的使用舒適度下降.美國的David Mayhew等研制出的MACARM[6]上肢康復(fù)機器人及意大利Giulio Rosati等研制出的NeReBot[7]、MariBot[8]5自由度上肢康復(fù)機器人均屬于繩驅(qū)動非穿戴式機器人,雖然結(jié)構(gòu)簡單,但所需驅(qū)動數(shù)大于機構(gòu)自由度數(shù),造成額外系統(tǒng)質(zhì)量.其他如意大利的Tobias Nef等研制的ARMin[9]上肢康復(fù)訓(xùn)練機器人,以及美國華盛頓大學(xué)Joel C. Perry等研發(fā)的CADEN-7[10]外骨骼機器人,均為非穿戴式上肢設(shè)備,機構(gòu)龐大,康復(fù)地點固定,不具備輕便性.
本文作者面向上肢運動障礙患者,改善現(xiàn)存上肢康復(fù)機構(gòu)結(jié)構(gòu)設(shè)計的不足,采用串并混聯(lián)式結(jié)構(gòu),以滿足患者日??祻?fù)需求為目標(biāo),設(shè)計了一種結(jié)合柔性材料的混聯(lián)上肢可穿戴康復(fù)訓(xùn)練機器人,并對其運動學(xué)、運動靜力學(xué)進行了分析,通過仿真驗證其作為人體上肢康復(fù)機構(gòu)本體的可行性.
上肢主要由肩關(guān)節(jié)、肘關(guān)節(jié)、前臂和手部連接.共具有7個運動自由度.肩關(guān)節(jié)簡化為1個球窩關(guān)節(jié),具有屈/伸、外展/內(nèi)收、旋內(nèi)/旋外3個自由度;肘關(guān)節(jié)簡化為1個鉸關(guān)節(jié),具有1個屈/伸自由度;前臂具有旋內(nèi)/旋外1個自由度;腕關(guān)節(jié)提供屈/伸、外展/內(nèi)收、旋內(nèi)/旋外2個自由度.我國成年人人體尺寸標(biāo)準如表1所示.
表1 人體上肢結(jié)構(gòu)尺寸
結(jié)合人體軀干平均尺寸參數(shù),并依此設(shè)計如圖1所示的康復(fù)訓(xùn)練機構(gòu).該機構(gòu)包括肩部機構(gòu)、肘部機構(gòu)、及手腕機構(gòu)三大部分.
肩部機構(gòu)為3-UPS/S并聯(lián)機構(gòu),由肩部固定基座、3條完全相同的UPS支鏈組成,具有空間3個轉(zhuǎn)動自由度.每條運動支鏈由萬向節(jié)、氣缸及球鉸構(gòu)成.穿戴時,患者肢體肩關(guān)節(jié)可視為球鉸,通過定長桿(上臂)與肘部平臺(圖示動平臺1)固接.整體形成3-UPS/S并聯(lián)結(jié)構(gòu).因此,肘部平臺由于機械約束只能實現(xiàn)以肩關(guān)節(jié)為轉(zhuǎn)動中心的空間三維轉(zhuǎn)動.肘部平臺姿態(tài)可由3條支鏈氣缸驅(qū)動進行調(diào)節(jié),實現(xiàn)大臂3個自由度的轉(zhuǎn)動.
肘部機構(gòu)為平面四桿機構(gòu),可實現(xiàn)肘部1個轉(zhuǎn)動自由度.動平臺1與動平臺2鉸接,并通過氣缸驅(qū)動伸縮,實現(xiàn)肘關(guān)節(jié)屈伸運動.調(diào)節(jié)連桿用于適應(yīng)不同患者前臂尺寸,以提高穿戴舒適度.
前臂及手腕機構(gòu)為編織手套,采用人造肌肉驅(qū)動.基于燕大柔性可穿戴手套[11],改進人造肌肉配置方式使之適用于患者手掌的多自由度不規(guī)則運動形式.手腕部分使用收縮人造肌肉,當(dāng)充氣施加壓力,收縮人造肌肉縮短提供拉力.人造肌肉2充氣縮短,人造肌肉3放氣伸長實現(xiàn)手腕內(nèi)收;人造肌肉3充氣縮短,人造肌肉2放氣伸長完成手腕外展運動;同理,手腕屈伸運動由相拮抗的人造肌肉4和人造肌肉1實現(xiàn).手腕環(huán)轉(zhuǎn)自由度由彎曲人造肌肉控制,以人工伸肌為材料,肌肉通過增加施加壓力彎曲,彎曲角度隨施加壓力的增加而增加.
建立如圖2所示肩部機構(gòu)運動學(xué)模型.圖中,并聯(lián)機構(gòu)轉(zhuǎn)動副分布在以肩關(guān)節(jié)O1為圓心,半徑為h的周邊圓上.動平臺1的圓心為O2,半徑為r,Ai為U型副中心,Bi為球鉸中心.以O(shè)1為原點建立全局基礎(chǔ)坐標(biāo)系O1-x1y1z1,x1指向A1.以O(shè)2為原點建立基礎(chǔ)坐標(biāo)系O2-x2y2z2,x2軸指向B1.肩部3個氣缸的長度為li(i=1,2,3),人體上臂O1O2長為s,動平臺相對于定平臺的一般姿態(tài)變換矩陣為
RT=Rot(z,γ)·Rot(y,β)·Rot(x,α)
(1)
已知在O1-x1y1z1坐標(biāo)系中Ai的坐標(biāo)和O2-x2y2z2坐標(biāo)系中Bi的坐標(biāo),則O1Bi在全局坐標(biāo)系中可表示為
O1Bi=O1O2+RT·O2Bi′
(2)
可得
(3)
對于單一支鏈,其矢量閉環(huán)示意圖如圖3所示.
建立矢量閉環(huán)方程為
O1O2+O2Bi=O1Ai+AiBi
(4)
矢量方程式(4)對時間進行求導(dǎo)得
(5)
式(5)兩端叉乘wi得到支鏈角速度為
(6)
式中JJ為一個3×3矩陣,即
JJ=
(7)
Ki為一個3×4矩陣,即
(8)
式(5)兩端點乘wi得到伸縮運動速度為
(9)
建立如圖4所示肘部機構(gòu)運動學(xué)模型.該模型建立在肩部機構(gòu)動平臺的基礎(chǔ)上,轉(zhuǎn)動副C1、C2、C3分布在延z2向上平移距離p所得的圓周O3上,以O(shè)3為原點建立基礎(chǔ)坐標(biāo)系O3-x3y3z3,x3軸指向C1,該坐標(biāo)系與O2-x2y2z2同向.動平臺2圓心為O4,半徑為k.肘部氣缸長度為l4,小臂O3O4長為n.該機構(gòu)可簡化為RPRR平面四桿機構(gòu)模型(圖5),其中C2、C3共轉(zhuǎn)動軸線.
根據(jù)手肘部分幾何關(guān)系,可得l4與θ的關(guān)系為
l4=
(10)
計算肘部氣缸速度.肘部支鏈示意見圖5.
與肩部速度求解同理.O2-x2y2z2坐標(biāo)系下肘部角速度ω4為
(11)
式中:ωb為動平臺2相對動平臺1的角速度;Jz為雅克比矩陣
Jz=
(12)
w4為O2-x2y2z2坐標(biāo)下l4上的單位向量
(13)
RT′·vs
(14)
式中RT′為一個3×4矩陣,即
(15)
全局坐標(biāo)下動平臺2角速度ωb′為
(16)
式中:RT″為一個3×4矩陣,即
(17)
全局坐標(biāo)下肘部角速度w4′為
w4′=RT·w4
(18)
(19)
由式(9)可知,肩部雅可比矩陣為
(20)
由肩部雅可比矩陣行列式[Ja]=0,得到h=0或r=0或α、β、γ3個角度之間關(guān)系式為
(21)
其中:a1=2sinα·(s-rsinβ)·
(r-rcosα·cosβ+2s·sinβ)
a2=-2cosα·(s-rsinβ)·(2s+rsinβ)+
cosβ·(r2-4s2-r2cos(2α)+
rs(-3+cos(2α))·sinβ)
此時肩部處于奇異位置.由式(19)可知,肘部雅可比矩陣為
[Jb]=[O3D1×w4]
(22)
由肘部雅可比矩陣行列式det[Jb]=0,得到角度θ=-90°或θ=90°.此時肘部處于奇異位置.
由機構(gòu)仿真運動到邊界得到康復(fù)機構(gòu)運動邊界范圍.表2為人體上肢關(guān)節(jié)活動范圍與康復(fù)機構(gòu)運動邊界范圍.
表2 人體上肢關(guān)節(jié)活動范圍與康復(fù)機構(gòu)運動邊界范圍
由表2可知,除肩關(guān)節(jié)伸運動、內(nèi)收運動及肘關(guān)節(jié)伸運動外,人體上肢關(guān)節(jié)活動范圍基本包括在康復(fù)機構(gòu)運動邊界范圍之內(nèi).且此上肢康復(fù)機構(gòu)運動邊界范圍滿足偏癱患者上肢七級評估分級表康復(fù)規(guī)定動作.
運動靜力學(xué)分析基于虛功原理,其將運動過程的每一時刻通過靜力學(xué)建模,建立慣性力、驅(qū)動力和其余外力的靜平衡關(guān)系.由于此機構(gòu)在承載人體上肢重力的情況下,緩慢按照預(yù)定軌跡進行康復(fù)運動,因此在建模過程中,可忽視加速度項引起的慣性力變化.
為獲取機構(gòu)受力關(guān)系,建立如圖6所示的氣缸模型[12].以肩部氣缸為例.氣缸由質(zhì)量為m1的缸體和質(zhì)量為m2的活塞組成.e1是Ai和第i(i=1,2,3)條支鏈缸體質(zhì)心距離,e2是Bi與第i(i=1,2,3)條支鏈中活塞質(zhì)心距離.
考慮肘部裝置、人體前臂以及手腕裝置重量,設(shè)力臂作用在手臂的質(zhì)心,動平臺2部分只受重力,力臂項為零.建立如圖7所示肘部模型.
與肩部氣缸模型一樣:肘部e3是C1與圓筒質(zhì)心距離,質(zhì)量m3;e4是D1與活塞質(zhì)心的距離,質(zhì)量m4.動平臺2的質(zhì)量為m0′,mn為前臂質(zhì)心質(zhì)量,mt為前臂兩端長度調(diào)節(jié)桿件質(zhì)量.
(23)
其中
(24)
(25)
其中
(26)
動平臺2速度項v2為
(27)
其中
[J2]=
(28)
O3O4=[-ncosθ(cosγsinβcosα+sinγsinα) 0
nsinθcosβcosα]T
(29)
人體前臂速度項v3為
(30)
其中
(31)
(32)
(33)
動平臺2質(zhì)心受力項F2為
(34)
人體前臂受力項F3為
(35)
式中M2=[M2xM2yM2z]為肘部自主施加力矩.
根據(jù)虛功原理可得
[J2]T·F2+[J3]T·F3=0
(36)
結(jié)果為4×1方程組,代表各廣義速度方向的合力為0,處于平衡狀態(tài).由此可以計算得出任意靜止?fàn)顟B(tài)手肘部分氣缸所需力f4及此刻f1、f2、f3大小.
肩部承受康復(fù)裝置整體重量以及人體手臂重量,包含肩部機構(gòu)框架、上臂質(zhì)量、前臂質(zhì)量、手腕部動平臺及肘部氣缸裝置質(zhì)量(裝置及前臂質(zhì)心可簡化到一點).在全局坐標(biāo)系下,建立如圖8所示的肩部運動靜力學(xué)模型.圖中ms為人體上臂質(zhì)量.
(37)
(38)
(39)
其中
(40)
動平臺1速度項v1為
(41)
其中
(42)
O1O2=[s(cosγsinβcosα+sinγsinα)s(sinγsinβcosα-sinαcosγ)scosβcosα]T
(43)
上臂速度項v4為
(44)
其中
[J4]=
(45)
由于在康復(fù)訓(xùn)練過程中人體肘部處于放松隨動狀態(tài),可得M2=03×1.
(46)
(47)
動平臺1質(zhì)心受力項F1為
(48)
上臂質(zhì)心受力項F4為
(49)
式中:M1=[M1xM1yM1z]為肩部自主施加力矩.
根據(jù)虛功原理可以得到
(50)
結(jié)果為一個4×1方程組,代表各廣義速度方向的合力為0,處于平衡狀態(tài).由此可以計算得出此時f1、f2、f3以及對應(yīng)肘部氣缸f4的驅(qū)動力大小.
患者進行康復(fù)訓(xùn)練的最終目的為恢復(fù)上肢日?;顒?,以康復(fù)中的提臂運動為例.
成年男性前臂重量約1.5 kg,長度約220 mm;上肢重量約3.5 kg,長度約為290 mm、手掌重量約0.3 kg.自主施加力矩M1=[0 50 0]、M2=03×1.各參數(shù)h=65 mm、r=50 mm、k=40 mm、e1=60 mm、e2=75 mm、e3=50 mm、e4=65 mm.基座、動平臺1、動平臺2采用PC塑料,氣缸及調(diào)節(jié)連桿材料為鋁合金.導(dǎo)入仿真軟件.仿真界面如圖9所示.
在人體上肢活動范圍內(nèi),給定廣義坐標(biāo)位置與時間關(guān)系方程為
(51)
式中:α(t)、β(t)、γ(t)、θ(t)單位為deg.
開始與結(jié)束姿態(tài)如圖10所示.通過機構(gòu)運動學(xué)逆解,由目標(biāo)軌跡方程求解出各個驅(qū)動在給任務(wù)期間的變化曲線.如圖11所示,分別為ADAMS數(shù)值仿真分析和理論解算所得的逆解結(jié)果,各桿長變化在時間段0~5 s內(nèi)的變化由于虛擬樣機裝配誤差,幅度和趨勢有少許誤差,在合理范圍之內(nèi),驗證了前述運動學(xué)建模的正確性.同時,如圖12所示,通過虛功原理對運動靜力進行解算,得出4個驅(qū)動力隨時間的變化曲線.與仿真結(jié)果進行對比,兩者曲線的走勢在1 s后趨于一致,在1 s前仿真具有明顯的波動.該波動是由于仿真初始位置不在目標(biāo)軌跡上,造成仿真器初始位置“瞬移”產(chǎn)生了較大加速度.驅(qū)動力曲線仿真數(shù)值始終比驅(qū)動力曲線理論數(shù)值大,該差值是由于虛擬仿真存在加速度,會產(chǎn)生一定慣性力,慣性力大小由部件質(zhì)量與此刻加速度大小決定.通過以上分析,驗證了運動靜力學(xué)建模的正確性,并為氣缸的選型提供了理論依據(jù).
1)設(shè)計了一種新型可穿戴柔性上肢康復(fù)訓(xùn)練機構(gòu),利用混聯(lián)結(jié)構(gòu)及柔性手套對比傳統(tǒng)剛性、串聯(lián)、繩驅(qū)動結(jié)構(gòu),在滿足康復(fù)訓(xùn)練所需運動自由度同時,肩部承載力更大,結(jié)構(gòu)更緊湊,前臂及手腕部更輕便.
2)對機構(gòu)剛性部分進行運動學(xué)建模,解算運動學(xué)逆解,并通過虛功原理建立機構(gòu)運動靜力學(xué)模型,得到特定上肢動作的運動學(xué)及運動靜力學(xué)理論解.
3)將康復(fù)外骨骼運動路徑導(dǎo)入ADAMS進行仿真,得到對應(yīng)運動學(xué)和運動靜力學(xué)仿真分析結(jié)果.與理論計算結(jié)果進行對比,驗證了模型及分析的正確性,為后續(xù)研究奠定了基礎(chǔ).