李安平LI An-ping
(重慶交通大學(xué)機(jī)電與車輛工程學(xué)院,重慶 400000)
隨著時(shí)代的進(jìn)步和科學(xué)技術(shù)的不斷進(jìn)步,人們的身體健康問題越來越受到重視,尤其是在人體癱瘓的輔助治療上。在后期自主康復(fù)的過程中,為了降低醫(yī)療患者家庭的生活費(fèi)用,進(jìn)而減輕治療帶來的心理壓力,減少大量公共醫(yī)療資源的消耗,輔助人體的康復(fù)機(jī)器人應(yīng)運(yùn)而生。康復(fù)機(jī)器人是工業(yè)機(jī)器人和醫(yī)用機(jī)器人的結(jié)合[1]。因此,目前康復(fù)機(jī)器人的驅(qū)動(dòng)手段主要以電機(jī)等,控制機(jī)器人帶動(dòng)人體做運(yùn)動(dòng)。但當(dāng)機(jī)器人應(yīng)用于人體時(shí),電機(jī)驅(qū)動(dòng)人體,使得施加力和剛強(qiáng)度過大,對(duì)患者身體造成二次損傷。這樣就產(chǎn)生了柔軟的關(guān)節(jié),廣泛應(yīng)用于醫(yī)療、制造、救援等領(lǐng)域。例如外骨骼機(jī)器人、柔性機(jī)械臂和足式機(jī)器人等機(jī)器人[2,3]。
近幾年國內(nèi)越來越多的院校和科研機(jī)構(gòu)對(duì)康復(fù)設(shè)備(柔性關(guān)節(jié)機(jī)器人)進(jìn)行了研究,并取得了一系列的研究成果。國內(nèi)外眾多學(xué)者基于氣動(dòng)肌肉群拮抗驅(qū)動(dòng)裝置設(shè)計(jì)了一種3自由度球關(guān)節(jié)結(jié)構(gòu)機(jī)器人[4,5];設(shè)計(jì)了一種捆扎交錯(cuò)式氣動(dòng)人工肌肉執(zhí)行器[6],以此來提高工作效率;在“cheetah”機(jī)器人系統(tǒng)中[7],使用拮抗式氣動(dòng)人工肌肉關(guān)節(jié)結(jié)構(gòu)。也將拮抗式或單/多根氣動(dòng)人工肌肉與改進(jìn)的多種機(jī)構(gòu)進(jìn)行結(jié)合,設(shè)計(jì)出了許多新型的柔性關(guān)節(jié),包括采用滑輪結(jié)構(gòu)將彈性元件與驅(qū)動(dòng)元件分開布置的氣動(dòng)人工肌肉驅(qū)動(dòng)串聯(lián)彈性關(guān)節(jié)[8]、通過利用一組平行的氣動(dòng)人工肌肉束拉動(dòng)滑板-連桿機(jī)構(gòu)產(chǎn)生旋轉(zhuǎn)運(yùn)動(dòng)的PAM-actuated重載機(jī)械臂[9]、兩根氣動(dòng)人工肌肉和兩根彈簧并聯(lián)的四桿關(guān)節(jié)機(jī)構(gòu)[10,11]等等。
人體下肢膝關(guān)節(jié)自由度是1,即,如圖1。只完成一個(gè)轉(zhuǎn)動(dòng)輸出。關(guān)節(jié)總體可將其分成三個(gè)部分,包括:氣動(dòng)人工肌肉驅(qū)動(dòng)部分;磁流變液制動(dòng)器剛性調(diào)節(jié)部分;連桿聯(lián)動(dòng)部分。即:在人工氣動(dòng)肌肉在拉伸的過程中,連接著磁流變液制動(dòng)器,通過調(diào)節(jié)引入的電壓電流,改變制動(dòng)器的阻抗強(qiáng)度,給人工氣動(dòng)肌肉拉伸的柔性不穩(wěn)定性,提供一定的轉(zhuǎn)動(dòng)剛度,穩(wěn)定的將驅(qū)動(dòng)轉(zhuǎn)力傳送到小腿骨的關(guān)節(jié),帶動(dòng)患者穩(wěn)定行走。
圖1 MRB-PAM復(fù)合驅(qū)動(dòng)膝關(guān)節(jié)
在本文的MRB-PAM復(fù)合驅(qū)動(dòng)仿生肩關(guān)節(jié)中,大腿端為固定端,氣動(dòng)人工肌肉、磁流變制動(dòng)器與小腿端為運(yùn)動(dòng)部件,運(yùn)動(dòng)部件的動(dòng)能Eki為
系統(tǒng)勢能。各連桿勢能為
MRB-PAM復(fù)合驅(qū)動(dòng)系統(tǒng)的拉格朗日動(dòng)力學(xué)方程為
式中τ是MRB-PAM仿生膝關(guān)節(jié)擺動(dòng)運(yùn)動(dòng)和氣動(dòng)人工肌肉拉縮運(yùn)動(dòng)的驅(qū)動(dòng)力矩,Ek為系統(tǒng)動(dòng)能,Ep為系統(tǒng)勢能。
小腿端的慣量矩陣為:
可以求出關(guān)節(jié)的總動(dòng)能為
將式(1)代入式(5)得
系統(tǒng)勢能表達(dá)式為
分別對(duì)系統(tǒng)的動(dòng)能和勢能求偏導(dǎo)為:
得出MRB-PAM關(guān)節(jié)的動(dòng)力學(xué)模型,即
將式(11)寫成矩陣形式為
式中:D(q)為慣性矩陣;C(q,q)表示離心力項(xiàng);G(q)表示重力項(xiàng);q表示關(guān)節(jié)角度,q表示關(guān)節(jié)角速度,q表示關(guān)節(jié)角加速度。
PAM具有形變率大、易控制等突出優(yōu)點(diǎn),但與此同時(shí),PAM還具有高度非線性、時(shí)變不確定性、響應(yīng)滯后性和受環(huán)境溫度影響大等特點(diǎn)[12],采用PAM與MRB的復(fù)合控制方式,利用磁流變阻尼器的柔性緩沖特性來彌補(bǔ)PAM控制精度較低的缺陷。采用RBF自適應(yīng)控制對(duì)關(guān)節(jié)進(jìn)行仿真。通過補(bǔ)償,實(shí)現(xiàn)復(fù)合仿生關(guān)節(jié)的高精度跟蹤[13]。
將式(13)代入式(16)可得到RBF自適應(yīng)控制動(dòng)力學(xué)模型,其中為τd未知項(xiàng)。
位置指令為:
被控對(duì)象的初值為
運(yùn)用MATLAB編寫程序,基于RBF自適應(yīng)控制對(duì)關(guān)節(jié)建立Simulink仿真模型,對(duì)MRB-PAM關(guān)節(jié)進(jìn)行仿真,仿真結(jié)果如圖2~圖7所示。
圖2 Simulink主程序
圖7 關(guān)節(jié)的建模不確定項(xiàng)逼近及其估計(jì)
圖6 關(guān)節(jié)的位置追蹤誤差
由圖3可以看出,仿生關(guān)節(jié)位置跟蹤大約在2.14s的時(shí)候跟蹤期望軌跡。由圖4可以看出,仿生關(guān)節(jié)速度跟蹤大約在1.46s的時(shí)候跟蹤期望軌跡。由圖5可以看出,仿生關(guān)節(jié)控制輸入,1.58s之后控制趨于平穩(wěn)。由圖7可以看出,仿生關(guān)節(jié)建模不確定項(xiàng)逼近及其估計(jì),估計(jì)值滯后于逼近值。
圖3 關(guān)節(jié)的位置追蹤
圖4 關(guān)節(jié)的速度追蹤
圖5 關(guān)節(jié)的控制輸入
對(duì)比以上圖可以發(fā)現(xiàn),通過系統(tǒng)對(duì)不確定項(xiàng)的逼近,仿生關(guān)節(jié)運(yùn)動(dòng)只在初始2.14s內(nèi)有較小誤差,隨后的位置跟蹤基本與理論軌跡重合。從仿真結(jié)果可以得出,采用控制方法不僅可使仿生關(guān)節(jié)獲得很好的位置跟蹤性能和速度追蹤性能,并大大降低了位置跟蹤誤差;很好地驗(yàn)證了本文的仿生關(guān)節(jié)的問題。
在關(guān)節(jié)重載的情況下很難精確控制的問題,提出了MRB-PAM仿生關(guān)節(jié);構(gòu)建了MRB-PAM復(fù)合仿生關(guān)節(jié)的動(dòng)力學(xué)模型;對(duì)MRB-PAM關(guān)節(jié)進(jìn)行了仿真。結(jié)果顯示仿生關(guān)節(jié)位置跟蹤大約在0.85s的時(shí)候跟蹤期望軌跡。仿生關(guān)節(jié)速度跟蹤大約在0.75s的時(shí)候跟蹤期望軌跡。結(jié)果表明,MRB-PAM復(fù)合生物關(guān)節(jié)的精密度、精密度和負(fù)重承受能力都很好,驗(yàn)證了MRB-PAM復(fù)合仿生關(guān)節(jié)結(jié)構(gòu)的合理性。