王偉偉 陳 鋒
(上海海事大學(xué) 物流工程學(xué)院,中國 上海 201306)
六足仿生機(jī)器人是指模仿六足生物的身體結(jié)構(gòu)、運(yùn)動(dòng)形式以及功能特征的機(jī)器人。這種機(jī)器人同時(shí)具有足式和仿生機(jī)器人的優(yōu)點(diǎn),具有良好的運(yùn)動(dòng)控制、位姿調(diào)整以及信息融合等能力。此外,六足機(jī)器人具有豐富的步態(tài),穩(wěn)定性好、越障能力強(qiáng),具有很好的地形適應(yīng)能力,在國民經(jīng)濟(jì)和國防建設(shè)的許多領(lǐng)域中都有廣泛的應(yīng)用前景[1]。自20世紀(jì)60年代以來,國內(nèi)外已經(jīng)研制出許多這類機(jī)器人的模型或樣機(jī)。
機(jī)器人系統(tǒng)是由結(jié)構(gòu)系統(tǒng)與控制系統(tǒng)兩個(gè)子系統(tǒng)組成的。這兩個(gè)子系統(tǒng)相互影響,緊密耦合。因此,對兩者進(jìn)行集成設(shè)計(jì)十分必要。而實(shí)際情況中,結(jié)構(gòu)設(shè)計(jì)者往往采用有限元?jiǎng)恿Ψ治龇椒ㄔO(shè)計(jì)結(jié)構(gòu),使得結(jié)構(gòu)系統(tǒng)模型自由度很高,方程組的維數(shù)大,并且含有許多非線性項(xiàng)。這就造成控制設(shè)計(jì)者無法利用該模型,而只能根據(jù)特別簡化的數(shù)學(xué)模型來對控制器系統(tǒng)進(jìn)行初步設(shè)計(jì)。此外,由于簡化模型是通過對實(shí)際系統(tǒng)進(jìn)行大量簡化得到的,使得模型中的參數(shù)不能跟實(shí)際情況很好地對應(yīng),所以控制結(jié)果也無法對結(jié)構(gòu)設(shè)計(jì)進(jìn)行有效的指導(dǎo)[2]。這種對結(jié)構(gòu)與控制系統(tǒng)進(jìn)行分離設(shè)計(jì)的方法會使得產(chǎn)品的研發(fā)周期長、成本高、性能差。
六足機(jī)器人是機(jī)電高度集成的系統(tǒng),而系統(tǒng)的動(dòng)態(tài)性能由結(jié)構(gòu)及控制共同決定。在高性能軌跡跟蹤過程中,結(jié)構(gòu)和控制的耦合更加緊密。若在設(shè)計(jì)六足機(jī)器人的控制系統(tǒng)時(shí)未能考慮到它的結(jié)構(gòu)特征,將會使跟蹤誤差偏大,甚至達(dá)不到性能要求指標(biāo);另一方面,若在進(jìn)行結(jié)構(gòu)設(shè)計(jì)時(shí)未能考慮到控制特性,將設(shè)計(jì)不出最優(yōu)結(jié)構(gòu)。為了使六足機(jī)器人系統(tǒng)設(shè)計(jì)達(dá)到最優(yōu),應(yīng)該對控制和結(jié)構(gòu)進(jìn)行集成優(yōu)化設(shè)計(jì)[3]。
六足機(jī)器人主要由軀干、驅(qū)動(dòng)器以及六條腿構(gòu)成。所有的驅(qū)動(dòng)器都采用舵機(jī)。在軀干部分安裝六臺舵機(jī),通過鋼絲繩分別驅(qū)動(dòng)六條腿機(jī)構(gòu)的跟關(guān)節(jié)來實(shí)現(xiàn)正反轉(zhuǎn)。
圖1 六足機(jī)器人腿結(jié)構(gòu)傳動(dòng)原理
在自然界里,很多昆蟲的腿部結(jié)構(gòu)是由基節(jié)、股節(jié)以及脛節(jié)三部分組成的?;?jié)繞著跟關(guān)節(jié)轉(zhuǎn)動(dòng),股節(jié)繞著髖關(guān)節(jié)轉(zhuǎn)動(dòng),脛節(jié)繞著膝關(guān)節(jié)轉(zhuǎn)動(dòng)。這些轉(zhuǎn)動(dòng)都是單自由度旋轉(zhuǎn)運(yùn)動(dòng)。整個(gè)腿結(jié)構(gòu)屬于一個(gè)三自由度的開式鏈結(jié)構(gòu)[4]。六足機(jī)器人的運(yùn)動(dòng)主要由“跨步”和“抬放腿”兩部分組成。
圖1為六足機(jī)器人腿機(jī)構(gòu)的內(nèi)部結(jié)構(gòu)圖。桿1與桿2都是主動(dòng)桿,它們分別與兩臺驅(qū)動(dòng)器的輸出軸連接。桿3和桿4是從動(dòng)桿。桿3固結(jié)在股節(jié)上,桿4固結(jié)在脛節(jié)上。并分別在軸2和軸3位置形成轉(zhuǎn)動(dòng)副。 過渡桿由兩根桿固結(jié)而成,且過渡桿的上、下兩桿所在平面相互平行,兩桿互成一定的角度。桿1和桿3在同一個(gè)平面上,桿2和過渡桿下桿處于同一平面,桿4和過渡桿上桿處于同一平面。桿1和桿3用一對鋼絲繩連接起來,桿2和過渡桿下桿用一對鋼絲繩連接起來;桿4和過渡桿上桿用一對鋼絲繩連接起來。
當(dāng)桿1逆時(shí)針旋轉(zhuǎn)時(shí),與桿3固結(jié)在一起的股節(jié)通過鋼絲繩的傳動(dòng),也開始作逆時(shí)針旋轉(zhuǎn)。當(dāng)桿2逆時(shí)針旋轉(zhuǎn)時(shí),過渡桿下桿通過鋼絲繩的帶動(dòng),也開始作逆時(shí)針旋轉(zhuǎn)。由于過渡桿的上、下兩桿固結(jié)在一起,所以,當(dāng)過渡桿下桿逆時(shí)針旋轉(zhuǎn)時(shí),過渡桿上桿也逆時(shí)針旋轉(zhuǎn)。并且上、下兩桿的轉(zhuǎn)角一致,從而帶動(dòng)與桿4固結(jié)的脛節(jié)旋轉(zhuǎn)。這樣,當(dāng)桿1和桿2同時(shí)同向旋轉(zhuǎn)時(shí),股節(jié)與脛節(jié)也跟著作相同的轉(zhuǎn)動(dòng)。這樣就實(shí)現(xiàn)了腿機(jī)構(gòu)的“抬放腿”動(dòng)作。
六足機(jī)器人行走時(shí),處于擺動(dòng)相的各條腿類似于機(jī)械手臂,即從跟關(guān)節(jié)開始由依次串聯(lián)的基節(jié)、股節(jié)和脛節(jié)構(gòu)成[5]。所以要求各條腿的驅(qū)動(dòng)關(guān)節(jié)和足端的關(guān)系,就要先確定各條腿節(jié)之間的相對運(yùn)動(dòng)與位姿關(guān)系。六足機(jī)器人的運(yùn)動(dòng)學(xué)正解就是在已知機(jī)器人軀體的位姿和各驅(qū)動(dòng)關(guān)節(jié)的轉(zhuǎn)角的情況下,求解足端的運(yùn)動(dòng)規(guī)律。
圖2 六足機(jī)器人腿部的D-H坐標(biāo)系
設(shè) θ1、θ2、θ3分別表示跟關(guān)節(jié)、髖關(guān)節(jié)和膝關(guān)節(jié)的轉(zhuǎn)角,I1、I2、I3分別表示基節(jié)、股節(jié)和脛節(jié)的長度。λ表示基節(jié)兩部分的夾角;ai為腿節(jié)長度;ai為關(guān)節(jié)軸線的扭角;di為公垂線間的距離。
相鄰坐標(biāo)系之間的轉(zhuǎn)換矩陣為:
選擇跟關(guān)節(jié)處的坐標(biāo)系為基坐標(biāo)系,把相鄰的關(guān)節(jié)變換矩陣相乘,即可得到六足機(jī)器人足端坐標(biāo)系的轉(zhuǎn)換矩陣:
六足機(jī)器人的運(yùn)動(dòng)學(xué)逆解就是在已知機(jī)器人位姿的情況下求解各驅(qū)動(dòng)關(guān)節(jié)的轉(zhuǎn)角。這里,通過將逆變換矩陣左乘于方程兩邊的方法,把關(guān)節(jié)變量分離出來,從而求出關(guān)節(jié)轉(zhuǎn)角。逆解的表達(dá)式為:
為了使整體六足機(jī)器人系統(tǒng)設(shè)計(jì)達(dá)到最優(yōu),應(yīng)該將結(jié)構(gòu)與控制系統(tǒng)進(jìn)行集成設(shè)計(jì),即把結(jié)構(gòu)優(yōu)化和控制優(yōu)化綜合在一起,通過優(yōu)選結(jié)構(gòu)設(shè)計(jì)變量和控制設(shè)計(jì)變量以達(dá)到優(yōu)化綜合目標(biāo)函數(shù)的目的[6]。
圖3 六足機(jī)器人集成優(yōu)化的流程
結(jié)構(gòu)優(yōu)化目標(biāo)函數(shù):
控制優(yōu)化目標(biāo)函數(shù):
綜合目標(biāo)函數(shù):
式中,α1、α2分別為結(jié)構(gòu)和控制的加權(quán)系數(shù), 滿足條件 0<α1,α2<1,且 α1+α2=1。
設(shè)六足機(jī)器人足尖末端的運(yùn)動(dòng)軌跡為:
通過六足機(jī)器人運(yùn)動(dòng)學(xué)逆解,可以得到各原動(dòng)件的輸入變化規(guī)律。把原動(dòng)件的運(yùn)動(dòng)規(guī)律輸入至六足機(jī)器人系統(tǒng)動(dòng)態(tài)方程,并利用遺傳算法對六足機(jī)器人結(jié)構(gòu)系統(tǒng)和控制系統(tǒng)進(jìn)行分離優(yōu)化設(shè)計(jì)求解。然后,進(jìn)行集成優(yōu)化設(shè)計(jì)求解,算法參數(shù)見表1。
表1 遺傳算法參數(shù)
Matlab仿真結(jié)果輸出:
圖4 集成、分離設(shè)計(jì)的末端執(zhí)行器X(左)、Y(右)方向跟蹤誤差對比
(1)本文設(shè)計(jì)了一種六足機(jī)器人機(jī)構(gòu),并給出了整體機(jī)構(gòu)的虛擬樣機(jī)模型。
(2)根據(jù)D-H坐標(biāo)變換對六足機(jī)器人進(jìn)行了運(yùn)動(dòng)學(xué)分析。
(3)建立了六足機(jī)器人的集成優(yōu)化模型。數(shù)值結(jié)果表明,集成設(shè)計(jì)的方法比分離設(shè)計(jì)方法能更好地進(jìn)行軌跡跟蹤。
[1]熊有倫,丁漢,劉恩滄.機(jī)器人學(xué)[M].北京:機(jī)械工業(yè)出版社,1993.
[2]訾斌,朱真才,曹建斌.混合驅(qū)動(dòng)柔索并聯(lián)機(jī)器人的設(shè)計(jì)與分析[J].機(jī)械工程學(xué)報(bào),2011,47(17):1-8.
[3]張逸群,段寶巖,李團(tuán)結(jié).空間可展開天線展開過程軌跡與控制系統(tǒng)集成設(shè)計(jì)[J].機(jī)械工程學(xué)報(bào),2011,47(9):21-28.
[4]陽如坤.全方位六足步行機(jī)器人分析—腿機(jī)構(gòu)、運(yùn)動(dòng)學(xué)、靜力學(xué)分析、步態(tài)規(guī)劃與步行軟件[J].機(jī)器人,1992(1):58.
[5]祝捷,曹志奎,馬培蓀.SMA驅(qū)動(dòng)的微型雙三足步行機(jī)器人作全方位運(yùn)動(dòng)的研究[J].傳動(dòng)技術(shù),2002(4):11-15.
[6]李素蘭,黃進(jìn),段寶巖.一種雷達(dá)天線伺服系統(tǒng)結(jié)構(gòu)與控制的集成設(shè)計(jì)研究[J].機(jī)械工程學(xué)報(bào),2010,46(19):140-146.