柔性sexar式虛擬重力控制模型研究

柔性sexar式虛擬重力控制模型研究

1重新能力在重4人世界各國，特別是美國、俄羅斯和中國等航天技術(shù)發(fā)達(dá)的國家，正在努力發(fā)展各國的航天技術(shù)，并在世界高科技領(lǐng)域發(fā)揮主導(dǎo)作用。然而，宇宙環(huán)境是一個脆弱的環(huán)境。例如，在太空環(huán)境中移動的運(yùn)動員的身體重量下沉，這將對運(yùn)動員的生理系統(tǒng)產(chǎn)生不利影響，如運(yùn)動能耗、肌肉萎縮、肌肉和心臟系統(tǒng)功能障礙。嚴(yán)重或危及運(yùn)動員的生命。為了減少這種不利影響，確?？哲娷壽E中人員的身體健康和高效工作能力，必須采取具體措施。特別是要加強(qiáng)對空間軌跡中墜落人員的力量訓(xùn)練。適當(dāng)?shù)腻憻挷粌H可以鍛煉肌肉和骨骼，還可以增加人體的消耗氧，從而提高心血管系統(tǒng)的調(diào)節(jié)能力。目前,航天員太空飛行中采用的鍛煉方法主要有拉力器鍛煉、自行車功量計鍛煉、下體負(fù)壓鍛煉和跑臺鍛煉4種.拉力器鍛煉主要是鍛煉手、軀干和腹部的肌肉,防止肌肉群萎縮和力量減弱,但對調(diào)節(jié)整個人體功能的作用不是太明顯.自行車功量計是一種可以踏動的鍛煉設(shè)備,航天員在自行車功量計上進(jìn)行鍛煉可以防止心臟功能的衰減、骨骼肌質(zhì)量的下降、增加血量的循環(huán)和改善組織器官的血液供應(yīng),但它基本上不能防止立位耐力的降低.下體負(fù)壓鍛煉主要是改變體液的分布,減輕失重引起的心血管紊亂,但對肌肉萎縮和肌力衰退作用不大.跑臺鍛煉是一種全身性的運(yùn)動,比較好地刺激了航天員的心血管、骨骼和肌肉系統(tǒng),還可以促使神經(jīng)—肌肉功能的協(xié)調(diào)和提高人體機(jī)體適應(yīng)于各種應(yīng)急條件的耐力,但它只用兩個彈性束帶將航天員固定在跑臺上,并不能保證鍛煉過程中施加到人體的力為恒定的重力值.本文提出了一種基于繩索牽引的航天員機(jī)能訓(xùn)練機(jī)器人,通過機(jī)器人控制系統(tǒng)把重力負(fù)載施加到航天員的身體上,實現(xiàn)航天員在直立行走狀態(tài)下的運(yùn)動訓(xùn)練,并使航天員在太空微重力環(huán)境中感受到地面重力感.2索牽引柔性stel嫌犯的機(jī)構(gòu)模型人體的直立行走是一種復(fù)雜整體運(yùn)動.在正常行走過程中,人體的重心始終處于動態(tài)變化中,現(xiàn)有技術(shù)很難準(zhǔn)確、實時地測量出其所在位置.人體的骨盆上連腰椎,下與股骨構(gòu)成髖關(guān)節(jié),既作為脊柱的一環(huán)而運(yùn)動,又以髖關(guān)節(jié)為軸作相對于下肢的運(yùn)動.在直立行走過程中,人體骨盆的運(yùn)動不僅起著重要的平衡作用和協(xié)調(diào)作用,而且研究人體步態(tài)模型的專家依據(jù)能量守恒原理得出骨盆的運(yùn)動軌跡近似于人體重心的運(yùn)動軌跡.因此,本文將重力負(fù)載通過人體骨盆的中心處施加到航天員的身體上,使航天員在運(yùn)動訓(xùn)練的同時感受到地面重力的感覺.在直立行走過程中,人體骨盆需要完成一個復(fù)雜的空間6自由度運(yùn)動,即沿矢狀軸的平動(前后方向)、沿冠狀軸的平動(左右方向)、沿垂直軸的平動(上下方向)、繞矢狀軸的擺動(左右側(cè)擺)、繞冠狀軸的俯仰(前后俯仰)和繞垂直軸的轉(zhuǎn)動等6個運(yùn)動趨勢.文[9-10]從力的傳遞上分析了繩索牽引并聯(lián)機(jī)器人的機(jī)構(gòu)類型,證明要實現(xiàn)剛體的空間運(yùn)動需采用3R3T機(jī)構(gòu)類型.本文提出了一種基于繩索牽引的柔性Stewart平臺式航天員機(jī)能訓(xùn)練機(jī)器人,其機(jī)構(gòu)模型如圖1所示.機(jī)器人的動平臺通過負(fù)重背心在人體骨盆處與人體柔性連接,動平臺由6根繩索牽引,各繩索的另一端分別通過安裝在機(jī)架上的球心過輪(圖1中未畫出)與直流力矩電機(jī)驅(qū)動的滾輪相連接,電機(jī)驅(qū)動單元固定于基平臺的機(jī)架上.同時,每根繩索中間均安裝一個力傳感器,用于檢測繩索拉力的大小.另外,還包括一個輔助的測力跑臺裝置,通過測得的壓力計算出施加的虛擬重力值,也可以粗略地推算出人體重心軌跡.基于繩索牽引的航天員機(jī)能訓(xùn)練機(jī)器人的工作機(jī)理為:在訓(xùn)練過程中,航天員在測力跑臺上正常行走,繩索牽引系統(tǒng)提供一個虛擬重力場環(huán)境,即通過繩索牽引機(jī)器人控制系統(tǒng)把虛擬重力負(fù)載施加到人體上,在人體運(yùn)動過程中只產(chǎn)生豎直方向的虛擬重力,不產(chǎn)生橫向附加力,不影響重力方向以外其它方向上的運(yùn)動趨勢,使航天員運(yùn)動機(jī)能和肌力在虛擬重力環(huán)境中能夠得到鍛煉.在整個過程中,航天員是運(yùn)動趨勢的使動者,而繩索牽引系統(tǒng)只提供一個虛擬重力環(huán)境.這樣既可以保持微重力條件下長期生活的航天員的運(yùn)動機(jī)能和體力,又可以通過所產(chǎn)生的虛擬重力環(huán)境(虛擬現(xiàn)實環(huán)境)對航天員的心理和精神起到康復(fù)作用.3機(jī)器人控制策略robotcoordina3.1約朗伯原理下的機(jī)器人初始的大力力基于繩索牽引的航天員機(jī)能訓(xùn)練機(jī)器人系統(tǒng)的受力情況如圖2所示.設(shè)機(jī)器人機(jī)構(gòu)的固定笛卡兒直角坐標(biāo)系為Oxyz,在固定坐標(biāo)系中繩索與基架的連接點(diǎn)為Bi(i=1,2,···,6);人體骨盆的局部坐標(biāo)系為PxPyPzP,點(diǎn)P為人體骨盆的中心,在局部坐標(biāo)系中繩索與負(fù)重背心的連接點(diǎn)為Pi(i=1,2,···,6).記為人體骨盆相對于固定坐標(biāo)系Oxyz的位姿,XP為點(diǎn)P在Oxyz坐標(biāo)系中的位置坐標(biāo)(x,y,z),θP為人體骨盆的局部坐標(biāo)系PxPyPzP相對于固定坐標(biāo)系Oxyz的姿態(tài)(θx,θy,θz).設(shè)Li為從連接點(diǎn)Pi到連接點(diǎn)Bi方向上繩索的矢量,為第i根繩索的長度,ui=Li/li為第i根繩索方向的單位矢量,ri=PPi,ti為第i根繩索的拉力,fP和τP分別表示作用在人體上的合力和合力矩,即機(jī)器人末端的廣義力.基于達(dá)朗伯原理,人體所受的力學(xué)平衡方程可表示為:結(jié)合式(1)和(2),可得機(jī)器人輸出的廣義力為:當(dāng)機(jī)器人各結(jié)構(gòu)尺寸及其位形參數(shù)確定時,矩陣JT就可以直接求出.如果再知道各繩索拉力的大小,根據(jù)式(3)就可以計算出機(jī)器人末端的廣義輸出力.本課題研究的主要目的是產(chǎn)生一個z方向上的力,即虛擬重力.因此,可以對機(jī)器人的廣義輸出力方程式(3)進(jìn)行簡化,把6維的廣義輸出力系統(tǒng)轉(zhuǎn)化為單自由度虛擬重力控制系統(tǒng),從而得到在給定位姿下的各繩索的拉力與所要控制的虛擬重力之間的關(guān)系.除了z方向的力外,設(shè)定其它的廣義力為0.設(shè)fG為機(jī)器人系統(tǒng)所要控制的虛擬重力,則機(jī)器人的重力矢量為FG=00fG000T.由方程式(3)可得:式中:ZBi為點(diǎn)Bi在Oxyz坐標(biāo)系中的z軸坐標(biāo),XPi和YPi分別為點(diǎn)Pi在PxPyPzP坐標(biāo)系中的x軸坐標(biāo)和y軸坐標(biāo).由式(4)可以看出:加載的虛擬重力要受到各繩索的分力和人體位姿的影響,加載系統(tǒng)是一個多變量、多參數(shù)耦合、高度非線性的復(fù)雜系統(tǒng).3.2虛擬重力控制律設(shè)計基于繩索牽引的航天員機(jī)能訓(xùn)練機(jī)器人的虛擬重力控制系統(tǒng)是由6個單繩索單元力控制系統(tǒng)和加載對象(人體)組成的.基于單繩索力閉環(huán)的準(zhǔn)閉環(huán)虛擬重力控制策略如圖3所示,機(jī)器人的外環(huán)采用開環(huán)協(xié)同控制,內(nèi)環(huán)各繩索單元子系統(tǒng)進(jìn)行力閉環(huán)控制.機(jī)器人控制系統(tǒng)包括虛擬重力規(guī)劃模塊、繩索拉力規(guī)劃模型、繩索力控制器、機(jī)器人平臺、繩索力傳感器系統(tǒng)和人體位姿測量模型.所需施加的虛擬重力由虛擬重力規(guī)劃模塊確定,虛擬重力大小可根據(jù)訓(xùn)練需要來設(shè)定.人體位姿測量模型主要用來實時地計算人體骨盆的位置和姿態(tài),以便于在繩索拉力規(guī)劃中合理地分解規(guī)劃的虛擬重力.當(dāng)rankJT=6時,由式(3)根據(jù)期望的虛擬重力矢量可求得繩索拉力為:式(5)即為繩索拉力的規(guī)劃模型,它作為每個繩索系統(tǒng)的輸入指令,由單繩索的力閉環(huán)控制系統(tǒng)實現(xiàn)每根繩索的拉力控制,從而實現(xiàn)對訓(xùn)練人員的虛擬重力加載.單繩索力閉環(huán)控制和繩索牽引并聯(lián)機(jī)器人結(jié)構(gòu)矩陣JT的求解可以參見本文作者的前期研究成果.虛擬重力控制系統(tǒng)6根繩索的控制律為:式中:Kc為繩索力控制器的控制模型.4虛擬重力加載模擬實驗基于繩索牽引的航天員機(jī)能訓(xùn)練機(jī)器人的虛擬重力控制系統(tǒng)的實驗樣機(jī)如圖4所示,它由人體骨盆模擬機(jī)構(gòu)(1R2T動平臺)和6個繩索牽引單元組成.人體骨盆模擬機(jī)構(gòu)的小平臺由6根繩索牽引,繩索的另一端通過過輪與力矩電機(jī)驅(qū)動的滾輪相連接,且每根繩索中間分別串聯(lián)了一個拉力傳感器.為了檢驗虛擬重力的加載效果,在人體骨盆模擬機(jī)構(gòu)的4個角與基座之間安裝了4個壓力傳感器,通過采集的壓力傳感器信號分析加載的虛擬重力大小和作用點(diǎn).假定人體骨盆模擬機(jī)構(gòu)做直線運(yùn)動,其起始點(diǎn)為(-50,-50)(單位為mm)、終止點(diǎn)為(50,50)(單位為mm),姿態(tài)角始終為0?,且從t0時刻開始在x方向和y方向上分別以25mm·s-1的速度移動.為檢驗機(jī)器人在加載對象運(yùn)動過程中的虛擬重力加載效果,設(shè)定期望加載虛擬重力為350N,進(jìn)行了機(jī)器人系統(tǒng)的虛擬重力控制模擬實驗,實驗結(jié)果如圖5和圖6所示.圖5為人體骨盆模擬機(jī)構(gòu)受到的合力與合力矩曲線,虛擬重力大小是通過壓力傳感器直接測量出來的,而其它的合力和合力矩是利用拉力傳感器信號和骨盆模擬機(jī)構(gòu)的位姿信號通過式(3)計算出來的.從圖5可以看出,在靜止階段時,加載到骨盆模擬機(jī)構(gòu)上的虛擬重力和其它的合力與合力矩波動較小,這是因為只有繩索拉力是變化的而人體位姿是定值;在啟動過程中,骨盆模擬機(jī)構(gòu)受到的合力與合力矩發(fā)生突變,尤其在x方向與y方向上的合力有向反方向明顯增大的趨勢,這是由于在啟動瞬間骨盆模擬機(jī)構(gòu)的慣性力產(chǎn)生的影響;在運(yùn)動過程中,加載到骨盆模擬機(jī)構(gòu)上的實際虛擬重力在330N和370N之間,存在著±20N的波動,這是因為骨盆模擬機(jī)構(gòu)位姿信息和繩索拉力的動態(tài)變化引起的;骨盆模擬機(jī)構(gòu)在x方向與y方向上所受到的合力都大約在±6N之間,而繞3個軸的合力矩都大約在±0.6N·m之間,從鍛煉受訓(xùn)者的運(yùn)動機(jī)能來考慮,這對骨盆模擬機(jī)構(gòu)的運(yùn)動影響很小,不會影響訓(xùn)練效果.由此可知,機(jī)器人的虛擬重力控制策略是可行的,可以實現(xiàn)虛擬重力的加載控制.圖6為6根繩索的拉力曲線,虛線為期望虛擬重力通過繩索拉力規(guī)劃模塊求得的繩索拉力,實線為通過拉力傳感器直接測量的實際繩索拉力.從實驗曲線中可以看出,繩索拉力在開始時刻和結(jié)束時刻分別存在一個平緩階段,這是因為骨盆模擬機(jī)構(gòu)在這兩個階段處于靜止?fàn)顟B(tài);在骨盆模擬機(jī)構(gòu)運(yùn)動過程中,繩索1的拉力、繩索2的拉力和繩索5的拉力都呈減小趨勢變化,而繩索3的拉力、繩索4的拉力和繩索6的拉力都呈增大趨勢變化,這與骨盆模擬機(jī)構(gòu)的實際運(yùn)動趨勢是一致的.繩索力輸入信號和實際拉力信號在機(jī)構(gòu)移動過程中雖然存在微小波動,但繩索拉力信號始終能夠很好地跟蹤繩索力輸入信號.5虛擬重力控制實驗研究為了解決在微重力環(huán)境下長期生活的航天員的運(yùn)動機(jī)能下降、肌肉萎縮和肌力衰退等問題,提出了一種基于繩索牽引的航天員機(jī)能訓(xùn)練機(jī)器人.在對機(jī)器人系統(tǒng)進(jìn)行力學(xué)分析的基礎(chǔ)上提出了一種基于單繩索力閉環(huán)的準(zhǔn)閉環(huán)虛擬重力控制策略,并在實驗樣機(jī)上進(jìn)行了虛擬重力控制模擬實驗.研究結(jié)果表明:本文提出的準(zhǔn)閉環(huán)虛擬重力控