本文提出了一種具有三個(gè)轉(zhuǎn)動(dòng)自由度的并聯(lián)機(jī)器人機(jī)構(gòu),介紹了它的結(jié)構(gòu)和特點(diǎn),建立了該機(jī)器人機(jī)構(gòu)的運(yùn)動(dòng)學(xué)位姿、速度及加速度的正反解方程,并進(jìn)行了數(shù)值實(shí)例驗(yàn)證,為該機(jī)器人機(jī)構(gòu)的進(jìn)一步分析研究和開發(fā)奠定了理論基礎(chǔ)
1. 前言
并聯(lián)機(jī)器人具有輸出精度高、結(jié)構(gòu)剛性好、承載能力強(qiáng)、部件簡(jiǎn)單及運(yùn)動(dòng)學(xué)反解簡(jiǎn)單等許多串聯(lián)機(jī)器人所沒(méi)有的優(yōu)點(diǎn),近年來(lái)引起了機(jī)器人研究者的高度重視。其中,六自由度并聯(lián)機(jī)器人方面的研究已比較深入和成熟。三自由度并聯(lián)機(jī)器人是一種很有實(shí)用前景的機(jī)器人,其也越來(lái)越多地引起人們的注意。三自由度并聯(lián)機(jī)器人包括平面三自由度并聯(lián)機(jī)器人,球面三自由度并聯(lián)機(jī)器人和空間三自由度并聯(lián)機(jī)器人。球面三自由度并聯(lián)機(jī)器人能夠?qū)崿F(xiàn)運(yùn)動(dòng)平臺(tái)三維轉(zhuǎn)動(dòng),是一種角臺(tái)形式,由靜角臺(tái)、動(dòng)角臺(tái)和三組具有一定弧度的連桿架和連桿構(gòu)成,各聯(lián)接處均采用轉(zhuǎn)動(dòng)副。這種機(jī)構(gòu)結(jié)構(gòu)復(fù)雜、設(shè)計(jì)困難。
本文針對(duì)某水下運(yùn)動(dòng)模擬裝置提出一種具有三個(gè)轉(zhuǎn)動(dòng)自由度的并聯(lián)機(jī)器人平臺(tái),該機(jī)構(gòu)與球面三自由度并聯(lián)機(jī)器人相比,具有部件少,結(jié)構(gòu)簡(jiǎn)單,運(yùn)動(dòng)學(xué)方程形式簡(jiǎn)單,求解容易,計(jì)算量小,易于控制等優(yōu)點(diǎn)。這種并聯(lián)機(jī)構(gòu)不僅可用作特殊的運(yùn)動(dòng)模設(shè)備,還可以應(yīng)用于機(jī)器人三自由度柔性腕關(guān)節(jié)、肩關(guān)節(jié)等機(jī)器人結(jié)構(gòu)上,具有一定的應(yīng)用前景。
2. 結(jié)構(gòu)描述
圖1為所設(shè)計(jì)的三自由度并聯(lián)機(jī)器人機(jī)構(gòu)。上、下平臺(tái)是兩個(gè)不同長(zhǎng)度的等邊三角形q1q2q3和P1P2P3,其外接圓半徑分別為r和R。上下平臺(tái)形心點(diǎn)分別為C和O,形心點(diǎn)之間用固定桿長(zhǎng)的支撐桿相聯(lián)。P1q1、P2q2、P3q3之間用三根可以伸縮的支撐桿相聯(lián)接。固定支撐桿與下平臺(tái)固接,與上平臺(tái)運(yùn)動(dòng)副為球鉸,三根可以伸縮的支撐桿與上平臺(tái)運(yùn)動(dòng)副為球鉸,與下平臺(tái)運(yùn)動(dòng)副為虎克鉸。固定坐標(biāo)OXYZ置于下平臺(tái)三角形中央,原點(diǎn)位于O點(diǎn),Z軸垂直向上,X軸通過(guò)P2點(diǎn),方向如圖所示,Y軸平行于P1P3。OP1與X軸方向的夾角為q。固定于上平臺(tái)的動(dòng)坐標(biāo)系Cxyz原點(diǎn)位于形心C點(diǎn),x軸沿Cq1方向,y軸平行于q2q3,z軸垂直于上平臺(tái)。各鉸接點(diǎn)的坐標(biāo)為
Pi(Xi,Yi,0)T的絕對(duì)坐標(biāo)

圖
1 三自由度并聯(lián)機(jī)器人結(jié)構(gòu)
具有上述結(jié)構(gòu)的并聯(lián)平臺(tái)由于中間固定支撐桿限制了三個(gè)移動(dòng)自由度,從而使上平臺(tái)只能實(shí)現(xiàn)空間三維轉(zhuǎn)動(dòng)。當(dāng)機(jī)構(gòu)的移動(dòng)副作長(zhǎng)度變化時(shí),上平臺(tái)的位置參數(shù)隨之變化,實(shí)現(xiàn)三個(gè)自由度的轉(zhuǎn)動(dòng)。根據(jù)機(jī)構(gòu)自由度計(jì)算公式:
(1)
式中n為構(gòu)件數(shù),g為關(guān)節(jié)數(shù),f1為所有關(guān)節(jié)自由度總數(shù),對(duì)于本并聯(lián)機(jī)器人n=8,g=10,f1=21,故本機(jī)器人自由度F=3。
3. 運(yùn)動(dòng)學(xué)分析
3.1 運(yùn)動(dòng)學(xué)位姿反解
所謂機(jī)器人運(yùn)動(dòng)學(xué)位姿反解指已知輸出件的位置和姿態(tài),求解機(jī)構(gòu)輸入件的位置稱為機(jī)構(gòu)
位姿的反解。所設(shè)計(jì)的并聯(lián)機(jī)器人機(jī)構(gòu)的坐標(biāo)如圖1所示,設(shè)(a,b,g)T為動(dòng)坐標(biāo)系繞X,Y,Z三軸的轉(zhuǎn)動(dòng)角位移,C點(diǎn)在固定坐標(biāo)系下的坐標(biāo)為(0,0,zc)T,在上平臺(tái)運(yùn)動(dòng)過(guò)程中為定值。經(jīng)過(guò)齊次變換,在動(dòng)坐標(biāo)系下的鉸接點(diǎn)qi在OXYZ坐標(biāo)系中的坐標(biāo)Q i(XTi,YTi,ZTi)T可表示為
其中i=1,2,3,RT為坐標(biāo)轉(zhuǎn)換矩陣

(3)
式中c(?)表示cos(?),s(?)表示sin(?)。
則相應(yīng)的桿長(zhǎng)為
(4)
這樣當(dāng)已知上平臺(tái)的角位移,通過(guò)式(4)就可求得各桿的桿長(zhǎng)。
3.2 運(yùn)動(dòng)學(xué)位姿正解
當(dāng)給出三個(gè)驅(qū)動(dòng)器的三個(gè)輸入Li,計(jì)算運(yùn)動(dòng)平臺(tái)末端件的位置和姿態(tài),即為運(yùn)動(dòng)學(xué)的位姿正解。由式(4)

(5)
式中
式(5)為含有6個(gè)未知數(shù)的3個(gè)方程組成的線性方程組,若選其中的3個(gè)未知數(shù)lx,lz,mz作為基本變量,則其余的3個(gè)未知數(shù)可以表達(dá)成這3個(gè)變量的函數(shù)

(6)
式中,Fi,Di,Hi和Ii(i=1,2,3)為常數(shù),可以通過(guò)式(5)求得。此外,轉(zhuǎn)換矩陣RT中的元素存在下列關(guān)系

(7)
將式(6)代入式(7)中,可以得到只含有未知數(shù)lx,lz,mz的3個(gè)方程,進(jìn)一步整理后寫成下面的形式

(8)
i=1,2,3,fi,1,fi,2,fi,3是常數(shù),fi,4,fi,5是lx的一次多項(xiàng)式,fi,6是l的二次多項(xiàng)式。且f1,2,f1,3,f1,5,f3,2為零。
當(dāng)i=1時(shí),分別用1,lz,mz,lzmz,m2z乘以式(8)可得5個(gè)方程,當(dāng)i=2,3時(shí),分別用1,lz,mz,lzmz乘以式(8)可得8個(gè)方程,這13個(gè)方程中含有13個(gè)未知數(shù),可以寫成
BY=0 (9)
式中,B為13×13的矩陣,并且其元素為lx的多項(xiàng)式,Y是13×1的未知數(shù)向量,

(10)
式(9)是一齊次線性方程組,其有解的條件是其系數(shù)行列式為零,即
det| B |=0 (11)
從式(11)可得到關(guān)于lx的8次多項(xiàng)式

(12)
由此得到lx有8個(gè)可能的解,由對(duì)稱性知,lz,mz也各有8個(gè)解。因此,所設(shè)計(jì)的3自由度并聯(lián)機(jī)器人機(jī)構(gòu)對(duì)于一組給定的輸入桿長(zhǎng),上平臺(tái)最多有8個(gè)可能的位姿。
3.3 速度求解
根據(jù)所設(shè)計(jì)的并聯(lián)機(jī)器人機(jī)構(gòu)的結(jié)構(gòu)特點(diǎn),通過(guò)推導(dǎo)雅克比矩陣J可以得出速度運(yùn)動(dòng)學(xué)公式。由于所設(shè)計(jì)的機(jī)構(gòu)只有轉(zhuǎn)動(dòng),沒(méi)有平動(dòng)。根據(jù)圖1所示,當(dāng)已知上平臺(tái)的角速度 ,上平臺(tái)各鉸鏈點(diǎn)q1,q2和q3處的速度 (i=1,2,3)可以表示為

(13)