曹宇飛 樊 軍
(新疆大學(xué) 機械工程學(xué)院,烏魯木齊 830047)
當(dāng)前,我國農(nóng)業(yè)和工業(yè)生產(chǎn)過程中仍然存在很多的手工作業(yè)環(huán)節(jié),工作量大、效率低下。因此,本文設(shè)計了一個3-DOF下肢外骨骼機構(gòu),對其運動學(xué)進行分析,然后通過控制跨步調(diào)整腳著地位置的方法,確保了機構(gòu)的穩(wěn)定性。最后通過ADAMS仿真,結(jié)果顯示,本文建立的外骨骼機構(gòu)穩(wěn)定性良好,實現(xiàn)了助力目的,滿足設(shè)計要求。
下肢外骨骼機構(gòu)在工作時需具備負載能力大、強度大及仿人形運動等特點[1]。為了使下肢外骨骼穿戴方便及運動靈活,本文設(shè)計了一個具有3-DOF的下肢外骨骼機構(gòu),模型如圖1所示[2]。
圖1 下肢外骨骼機構(gòu)設(shè)計模型
此機構(gòu)主要由髖關(guān)節(jié)、膝關(guān)節(jié)、踝關(guān)節(jié)及足部等構(gòu)成。該設(shè)計機構(gòu)可以滿足穿戴者仿照正常的步態(tài)行走運動,準(zhǔn)確地模擬人體行走過程中的復(fù)雜耦合運動,可一定程度上保證行走的穩(wěn)定性。
機構(gòu)位置正解問題用指數(shù)積公式法來進行分析[3]。并聯(lián)結(jié)構(gòu)的正運動學(xué)公式可表示為:
矩陣的指數(shù)形式表示為式(2):
根據(jù)式(2),可推出O3點的位置公式:
機器人的運動學(xué)反解問題指已知其末端運動執(zhí)行器的位形,求此時機構(gòu)的所有關(guān)節(jié)轉(zhuǎn)角及位移的問題[4]。對于n自由度的開鏈機構(gòu),在式(1)兩邊均乘以(0),則可表達為:
˙
機構(gòu)各個支鏈的伸縮速度表示為L ,末端運動執(zhí)行器的廣義速度表示為X,并且要求。機構(gòu)的輸入和輸出的速度應(yīng)當(dāng)為,其中J=J2-1J1,J1表示逆雅克比矩陣,J2表示正雅克比矩陣[5]。
由以上可以發(fā)現(xiàn),此機構(gòu)J1的行列式不等于0。因此,下面基于J2來分析它的奇異位形。令det(J2)=0,可整理得:
由式(5)可知,當(dāng)a1=a3,a2=a4時,B點與H點重合,此處即為髖關(guān)節(jié)奇異位形處,即死點位置。
本文通過調(diào)整跨步腿落腳點的位置以改變支撐多邊形,使其在運動時可以跨過奇異位置,實現(xiàn)下肢外骨骼系統(tǒng)的運動連貫性和穩(wěn)定性,如圖2所示。
圖2 外骨骼系統(tǒng)腳著地位置的確定
根據(jù)式(6)可得腳的移動方向改變角αf,即奇異位置時歐拉角的逆運動角。
根據(jù)式(7)可得腳所移動的距離lf。
在因腿部的額外移動導(dǎo)致的重心變化量可忽略不計的情況下,當(dāng)下肢外骨骼系統(tǒng)位于新的落腳位置時,系統(tǒng)將處于穩(wěn)定狀態(tài)。
在腰部支架上添加一個重40kg的重物作為負載塊,并認為負載的重量完全作用在外骨骼上,構(gòu)建了人-機系統(tǒng)聯(lián)合負重模型,如圖3所示。
圖3 人-機系統(tǒng)聯(lián)合負重行走模型
運動學(xué)仿真過程如下:記錄仿真過程中的髖、膝和踝關(guān)節(jié)力矩變化;建立垂直于地面的支撐,在外骨骼足部底面與底面之間建立“固固相連”類型的接觸,并將重力加速度的大小和方向設(shè)定好;運行仿真,時間為2s,步數(shù)為50步。
如圖4所示,通過與人體負重時,各關(guān)節(jié)的力矩進行對比可以發(fā)現(xiàn),在穿戴上外骨骼后進行負重運動,人體下肢各關(guān)節(jié)的力矩與之前相比有明顯的減小,這說明本文所建立的下肢外骨骼具有助力特性而且效果突出,尤其是在髖關(guān)節(jié)以及膝關(guān)節(jié)處更為明顯。
本文首先建立了一個3-DOF下肢外骨骼的模型,對其運動學(xué)進行了分析,然后利用跨步調(diào)整腳著地位置的控制策略方法,確保機構(gòu)的穩(wěn)定性。最后通過ADAMS仿真,對比穿戴外骨骼前后人體各關(guān)節(jié)力矩,結(jié)果顯示,本文建立的下肢外骨骼機構(gòu)穩(wěn)定性良好,實現(xiàn)了助力目的,滿足設(shè)計要求。
圖4 穿戴外骨骼前后人體各關(guān)節(jié)力矩對比曲線