張莉潔,盧文濤,曹學(xué)民
(洛陽理工學(xué)院,河南洛陽471023)
在康復(fù)醫(yī)學(xué)和雙足機器人領(lǐng)域,人工膝關(guān)節(jié)是重要的功能部件。它可以幫助人體實現(xiàn)站立的支撐和行走時的靈活自然步態(tài)。自然人腿膝關(guān)節(jié)的轉(zhuǎn)動中心會隨屈伸動作而移動,即轉(zhuǎn)動運動中心是變化的,如圖1 其瞬時轉(zhuǎn)動中心的軌跡為J 型曲線。研發(fā)仿生性能良好的人工關(guān)節(jié)技術(shù)是康復(fù)工程學(xué)及仿生行走機器人學(xué)的重要課題。為更好地模擬人腿膝關(guān)節(jié)功能,采用四連桿仿生膝關(guān)節(jié),利用其可變瞬時轉(zhuǎn)動中心的運動學(xué)特性,實現(xiàn)膝關(guān)節(jié)的轉(zhuǎn)動多軸性,其良好的仿生特性得到了市場及大量學(xué)者的廣泛關(guān)注和研究[1-4]。四連桿膝關(guān)節(jié)機構(gòu)設(shè)計的好壞將決定其仿生性能,已得到國內(nèi)學(xué)者的廣泛關(guān)注。
圖1 膝關(guān)節(jié)瞬心軌跡圖
王斌銳等[3]在設(shè)計時同時考慮大腿和小腿的運動,采用旋轉(zhuǎn)矩陣和坐標變換法來表達踝關(guān)節(jié)軌跡,同時使膝關(guān)節(jié)和踝關(guān)節(jié)軌跡與目標軌跡重合。考慮到膝關(guān)節(jié)的作用只是保證大小腿的相對運動規(guī)律,因此設(shè)計時無需考慮大腿運動,該方法不必要地將優(yōu)化問題復(fù)雜化,使計算過于繁復(fù)。文獻[5-6]以轉(zhuǎn)動瞬心的J 型曲線為目標軌跡,使所設(shè)計的四連桿機構(gòu)的瞬心與J 型曲線重合,但考慮到若回轉(zhuǎn)半徑長度和位置不同,踝關(guān)節(jié)中心點軌跡也會不同,因此該方法無法同時保證踝關(guān)節(jié)軌跡能準確再現(xiàn)人腿實際軌跡,自然步態(tài)仍無法實現(xiàn),該設(shè)計方法不夠成熟?,F(xiàn)有文獻中少有對優(yōu)化后四連桿膝關(guān)節(jié)瞬心位置的圖解說明,其優(yōu)化結(jié)果的仿生性能仍有待進一步論證。
四連桿仿生膝關(guān)節(jié)機構(gòu)設(shè)計是機構(gòu)綜合問題,即在大腿固定不動的情況下,要求小腿實現(xiàn)相對擺動運動關(guān)系,即保證踝關(guān)節(jié)中心點的軌跡與人腿相應(yīng)關(guān)節(jié)中心軌跡重合,屬于軌跡生成問題。本文作者根據(jù)多軸膝關(guān)節(jié)的結(jié)構(gòu)特點,考慮小腿擺角范圍,擺動期靈活性的要求,以獲得實際人腿踝關(guān)節(jié)的運動軌跡為優(yōu)化目標,采用多變量優(yōu)化設(shè)計方法對四連桿多軸膝關(guān)節(jié)機構(gòu)進行優(yōu)化設(shè)計,使其能獲得自然人腿步態(tài),并通過運動仿真得到膝關(guān)節(jié)瞬心位置,分析驗證其運動仿生性能。
實驗人小腿長330 mm,踝關(guān)節(jié)中心點距離腳后跟40 mm,步態(tài)周期0.45 ~0.6 s,將大腿看作機架,通過人小腿擺動試驗得到踝關(guān)節(jié)的真實運動軌跡,如圖2 所示。選定目標點,使其準確再現(xiàn)運動軌跡。
圖2 踝關(guān)節(jié)真實運動軌跡實驗數(shù)據(jù)
為使連桿擺動范圍足夠大,考慮設(shè)計為曲柄搖桿機構(gòu),如圖3 所示,以鉸鏈點A 為坐標原點建立直角坐標系,其中機架AD為固定不動的大腿,其與x軸的夾角為φ0;桿BM 固連在連桿BC 上,作為仿生機構(gòu)的小腿,點M 即為踝關(guān)節(jié)中心點。BM 與BC 的夾角固定為λ;AB 為搖桿,CD 為曲柄,當(dāng)AB 擺動至位置i 時,與機架AD 的夾角為φi。
圖3 四連桿膝關(guān)節(jié)機構(gòu)模型
對應(yīng)連桿上點M 坐標可用下列函數(shù)表達為:
其中,λ 由BC 轉(zhuǎn)向BM,為負值,ρ 為BD,用自變量表達為:
其中,β=∠ADB;γ=∠BCD;α = ∠DBC;δ 為BC與AD 間的夾角,其值可按如下計算:
由以上知,點M 坐標是桿長l1,l2,l3,l4,l5,角度φ0,λ,φi的函數(shù)。φi為搖桿擺動至圖3 目標點處對應(yīng)的搖桿擺角,由此可確定設(shè)計變量為:
x= [x1x2x3x4x5x6x7x8x9x10… xm]T= [l1l2l3l4l5φ0λ φi]T,其中x8…x7+m為對應(yīng)m 個目標點相應(yīng)搖桿的轉(zhuǎn)角φi。由上可知,設(shè)計變量除了曲柄搖桿的結(jié)構(gòu)尺寸參數(shù)外,還有對應(yīng)各個目標點位置的擺角值,若取5 個目標點,則設(shè)計變量為12 個,若選取目標點m 個,則設(shè)計變量為7 +m 個。
優(yōu)化目標為連桿BC 上點M 的實際軌跡與目標軌跡重合。因此,以點M 實際軌跡上若干個點的坐標與理想軌跡上目標點的誤差均方根最小作為優(yōu)化目標。在實際優(yōu)化計算中,采用加權(quán)方法使目標函數(shù)能夠收斂,其函數(shù)表達式為:
式中:Sxi,Syi是踝關(guān)節(jié)理想軌跡的第i 個目標點坐標;Mxi,Myi是連桿BC 上點M 實際軌跡上第i 個點的坐標,ωi為保證收斂的加權(quán)值。
約束條件為不等式約束,表達式為gi(x)≤0。要成為曲柄搖桿機構(gòu),且使CD 桿l3為曲柄,應(yīng)滿足如下桿長條件:
膝關(guān)節(jié)應(yīng)保證擺動期靈活性,要求最小傳動角∠ABC≥30°,最小傳動角出現(xiàn)在曲柄CD 與機架共線的位置,即滿足以下非線性不等式:
根據(jù)膝關(guān)節(jié)尺寸比例限定設(shè)計變量邊界條件:
70≤l1≤110;60≤l2≤90;35≤l3≤60;40≤l4≤70;260≤l5≤290;-15≤φ0≤15;-120≤λ≤-90;-90≤φi≤-70,等。
優(yōu)化過程若在大范圍內(nèi)盲目搜索較為不易,且只能求出局部最優(yōu)解,因此為節(jié)省優(yōu)化時間,保證正確的搜索方向,應(yīng)先找出較為合理的初值。
根據(jù)膝關(guān)節(jié)尺寸比例,初定機架l4長度50 mm。考慮到支撐期的穩(wěn)定性,初設(shè)AD 夾角φ0=0°。采用圖解法取定初值,x = [78 63 40 50 284 0-119-85-60-43-35-31]。
該問題屬于非線性約束優(yōu)化問題,設(shè)計采用二次規(guī)劃算法。二次規(guī)劃法利用擬牛頓法 (變尺度法)來近似構(gòu)造海賽矩陣,確定搜索方向,建立二次規(guī)劃子問題進行迭代求解,因此又稱約束變尺度法。
Hessian 矩陣采用擬牛頓法進行迭代,變尺度矩陣的迭代公式采用穩(wěn)定的BFGS (Broyden-Fletcher-Gold farbshanno)算法。
本次設(shè)計借助MATLAB 軟件優(yōu)化函數(shù)fmincon 進行,由于該優(yōu)化問題含有非線性約束,且希望計算更為準確,采用medium-scale 的SQP 算法。優(yōu)化語句為:
[x,fval] = fmincon (@ mygoal,x0,A,b,[],[],lb,ub,nonlcon,options);其中,A,b 為公式(8)的矩陣表達式,nonlcon 為公式(9)非線性函數(shù)。@mygoal 為目標函數(shù),即為該優(yōu)化問題的數(shù)學(xué)模型,采用式(1) ~ (7)表達。
若初值選擇不同可得不同的優(yōu)化結(jié)果,因此優(yōu)化算法只能求出局部最優(yōu)解,選取較好的一組優(yōu)化結(jié)果如表1,實際軌跡與目標軌跡誤差為5.65 mm。
表1 四連桿機構(gòu)結(jié)構(gòu)參數(shù)優(yōu)化結(jié)果
為驗證優(yōu)化后的四連桿膝關(guān)節(jié)仿生特性的好壞,應(yīng)給出瞬心軌跡。對四連桿膝關(guān)節(jié)進行運動分析得其瞬心坐標表達式為:
圖4 為優(yōu)化結(jié)果與目標軌跡的比較,左上方十字軌跡為瞬心軌跡,其曲線形狀為J 型,進一步分析運動特性。
圖4 優(yōu)化結(jié)果實際軌跡與目標軌跡比較
圖5 為運動仿真,顯示出搖桿以均勻擺角擺動時四桿機構(gòu)運動的動態(tài)過程,仍畫出瞬心軌跡。由圖分析得,在運動初始位置即支撐期,其瞬心位置較為靠上,即膝關(guān)節(jié)伸展時,轉(zhuǎn)動中心大大高于連桿機械軸的位置。而在膝關(guān)節(jié)屈曲時,即之后的擺動過程中,瞬心隨膝屈曲急速下降,回到通常膝軸的位置。這樣使得支撐初期小腿長度變化,可減少穩(wěn)定膝關(guān)節(jié)所需的髖關(guān)節(jié)伸展肌力,確保了大腿假肢的支撐期穩(wěn)定性;而在擺動中期膝軸高度下降至正常位置,保證正常自然的運動姿態(tài),實現(xiàn)完美步態(tài)。
圖5 四桿機構(gòu)運動的動態(tài)過程
以上分析充分驗證了所設(shè)計的四連桿膝關(guān)節(jié)機構(gòu)具有良好的仿生性能,該仿生關(guān)節(jié)能獲得人腿自然步態(tài)。
圖6 為優(yōu)化后四連桿的初始位置,即支撐期位置,圖中看到瞬心位置位于髖踝線TA 線前方[7-8],則地面支撐反力將對瞬心產(chǎn)生驅(qū)動小腿擺動的力矩,因此支撐期穩(wěn)定性稍差,在此可采用智能磁流變阻尼器實現(xiàn)自承重自鎖式結(jié)構(gòu),即在連桿和機架間合適位置處安裝磁流變阻尼器[9],在支撐期,調(diào)整阻尼力為最大,從而實現(xiàn)自鎖承重。在擺動期,可調(diào)阻力的磁流變阻尼器與電機共同工作,使其在運動中獲得良好的減振性能。
圖6 優(yōu)化四連桿初始位置及瞬心位置比較
采用二次規(guī)劃優(yōu)化設(shè)計方法對四連桿仿生膝關(guān)節(jié)進行優(yōu)化,并通過運動仿真對優(yōu)化四連桿機構(gòu)進行仿真,得到以下結(jié)輪:
(1)所設(shè)計四連桿機構(gòu)在小腿擺動過程中,實際軌跡與目標軌跡吻合度良好,其速度瞬心呈J 型曲線,符合人腿自然步態(tài),充分驗證了四連桿膝關(guān)節(jié)良好的仿生特性。
(2)所設(shè)計四連桿機構(gòu)在支撐期時速度瞬心位置較為靠前,有利于擺動期靈活性,適合運動靈活性的使用要求,為保證支撐期的穩(wěn)定性推薦采用加裝智能磁流變阻尼器的自鎖承重式結(jié)構(gòu)。
(3)應(yīng)進一步對仿生膝關(guān)節(jié)驅(qū)動小腿擺動過程進行速度、加速度分析,考慮阻尼器的安裝,并進一步驗證其動力學(xué)性能。
[1]劉娜,刁興建.假肢膝關(guān)節(jié)概述[J].中國矯形外科雜志,2006,3(2):225-226.
[2]楊義勇,王人成,王延利,等.新型仿生膝關(guān)節(jié)的機構(gòu)設(shè)計與仿真[J].中國機械工程,2008,19(1):72-79.
[3]王斌銳,許宏,金英連,等.雙足機器人四連桿仿生膝關(guān)節(jié)的研究[J].機械設(shè)計,2006,7,23(7):13-15.
[4]吳成東,金基準,聞時光,等.基于混合驅(qū)動仿生膝關(guān)節(jié)機構(gòu)設(shè)計[J].沈陽建筑大學(xué)學(xué)報,2012,7,28(4):759-764.
[5]吳?,帲陨賱?,郝倩.假肢膝關(guān)節(jié)四桿機構(gòu)的優(yōu)化與仿真[J].機械設(shè)計,2011,28(9):42-45.
[6]李燕.基于Pro、Mechanism 的仿生膝關(guān)節(jié)優(yōu)化設(shè)計與運動仿真研究[J].機床與液壓,2009,37(6):183-185.
[7]張培育,金德聞.多軸膝關(guān)節(jié)假肢穩(wěn)定性的分析[J].中國康復(fù)醫(yī)學(xué)雜志,1998,13(1):18-20.
[8]RADELIFFE CW,DEG M S,PROFESSOR M E.Biomechanics of Knee Stability Control with Four-bar Prosthetic Knee [C].ISPO Australia Annual Meeting Melboume,Australia,2003:33-36.
[9]CHEN J Z,LIAO W H.Design,Testing and Control of a Magnetorheological Actuator for Assistive Knee Craces[J].Smart Materials and Structures,2010,19(3):29-35.