3T1R并聯(lián)機構(gòu)降耦設(shè)計與分析

朱小蓉 胡 旸 沈惠平 楊廷力 朱 偉

(常州大學(xué)機械工程學(xué)院， 常州 213164)

0 引言

3T1R并聯(lián)機構(gòu)由于能實現(xiàn)沿x、y、z軸的平動和繞固定軸(通常為z軸)的轉(zhuǎn)動，可用于分揀、包裝、碼垛、裝配等操作，在工業(yè)中得到大量應(yīng)用。最初的3T1R并聯(lián)機構(gòu)是在3-DOF Delta機器人[1]的基礎(chǔ)上加裝中間UPU支鏈以實現(xiàn)繞z軸的獨立轉(zhuǎn)動。在此之后，提出了一系列由4支鏈和鉸接雙動平臺組成的3T1R并聯(lián)機構(gòu)[2-8]，如H4、I4、Par4、Heli4、CrossIV等；文獻[9-14]提出了一類結(jié)構(gòu)對稱、具有4支鏈和剛性單動平臺的3T1R并聯(lián)機構(gòu)。上述能實現(xiàn)3T1R運動的并聯(lián)機構(gòu)中，含鉸接雙動平臺的機構(gòu)，通過2個子動平臺的相對運動和特定設(shè)計的傳動裝置能實現(xiàn)較大旋轉(zhuǎn)角，最大轉(zhuǎn)動范圍可達[-90°,90°]，但該類機構(gòu)的結(jié)構(gòu)和運動學(xué)都較為復(fù)雜；而剛性單動平臺3T1R機構(gòu)，由于支鏈耦合、機構(gòu)奇異性的影響，這些機構(gòu)的工作空間特別是轉(zhuǎn)動范圍受限，且這些機構(gòu)的耦合度較大(κ=2)，其運動學(xué)正解、動力學(xué)分析求解復(fù)雜。因此，為滿足工程實際應(yīng)用需要，還需要對解耦及大轉(zhuǎn)動能力的3T1R并聯(lián)機構(gòu)進行更多的研究。

根據(jù)基于方位特征(Position and orientation characteristic, POC)方程的并聯(lián)機構(gòu)拓撲結(jié)構(gòu)設(shè)計理論，文獻[15]提出了3種拓撲結(jié)構(gòu)降耦設(shè)計原理和方法,其中，基于運動副復(fù)合的設(shè)計方法，在降低機構(gòu)耦合度的同時，使機構(gòu)的結(jié)構(gòu)設(shè)計、制造變得更簡單，已成為并聯(lián)機構(gòu)拓撲結(jié)構(gòu)降耦設(shè)計的一種主要方法[16-18]。

文獻[19-21]提出了一種具有較好應(yīng)用前景的四自由度Quadrupteron并聯(lián)機構(gòu)，能實現(xiàn)三平移和繞動平臺法線的一個轉(zhuǎn)動輸出，但機構(gòu)的耦合度較高(κ=2)，且機構(gòu)的轉(zhuǎn)動能力受限。本文采用基于運動副復(fù)合的設(shè)計方法，對其進行結(jié)構(gòu)降耦，以得到一種自由度和末端件輸出運動類型保持不變，但機構(gòu)耦合度降低，且具有運動解耦的新機型。

1 降耦并聯(lián)機構(gòu)

1.1 機構(gòu)降耦設(shè)計

1.1.1Quadrupteron并聯(lián)機構(gòu)

圖1 Quadrupteron并聯(lián)機構(gòu)Fig.1 Kinematic diagram of Quadrupteron

Quadrupteron并聯(lián)機構(gòu)如圖1所示[22]，由1條CRR支鏈(Leg 1)和3條CRRR支鏈(Leg 2、Leg 3、Leg 4)連接定平臺和動平臺；與動平臺相連的4個R副的軸線與動平臺的法線相互平行；每條支鏈上其余的C副和R副軸線互相平行。

易知，當定平臺上4個C副的移動作為驅(qū)動時，動平臺可實現(xiàn)三平移和繞動平臺法線的轉(zhuǎn)動輸出；同時，該機構(gòu)由1個基本運動鏈(BKC)組成，且耦合度κ=2，其運動學(xué)正解及動力學(xué)正反解求解復(fù)雜。

1.1.2降耦設(shè)計

文獻[15]提出的基于運動副復(fù)合的結(jié)構(gòu)降耦設(shè)計方法，已對多種耦合度較高的并聯(lián)機構(gòu)進行了拓撲降耦優(yōu)化設(shè)計[15-18]。由于Quadrupteron機構(gòu)動平臺上的4個R副軸線平行，可以通過合并的方法達到機構(gòu)結(jié)構(gòu)降耦的目的。

保持CRR支鏈(Leg 1)不變，首先將圖1所示Quadrupteron并聯(lián)機構(gòu)的2條CRRR支鏈(Leg 2和Leg 3)上與動平臺連接的2個轉(zhuǎn)動副重合，合并成RD副，移至動平臺的中心；再拆開另1條CRRR支鏈(Leg 4)與動平臺相連的R副，并通過末端執(zhí)行件與RD副相連，則構(gòu)成圖2所示的新型降耦機構(gòu)，記為(3CRR/R)&CRRR并聯(lián)機構(gòu)。

圖2 (3CRR/R)&CRRR降耦并聯(lián)機構(gòu)Fig.2 (3CRR/R)&CRRR decoupled PM

這樣，降耦機構(gòu)由靜平臺0、中間平臺1和末端執(zhí)行件2組成。其中，靜平臺0和中間平臺1之間由轉(zhuǎn)動副R12、R13、R22、R23、R32、R33和圓柱副C11、C21、C31及相應(yīng)構(gòu)件組成，且滿足C11‖R12‖R13、C21‖R22‖R23、C31‖R32‖R33，裝配時C11、C21、C31互相正交；另一支鏈由C41、R42、R43和R44(正交的兩轉(zhuǎn)動副R43、R44可采用萬向節(jié)代替，記為U43)組成；旋轉(zhuǎn)軸RD固定在中間平臺1上，且垂直于中間平臺1；主動輸入為C11、C21、C31、C41的移動。

1.2 拓撲結(jié)構(gòu)特征分析

1.2.1機構(gòu)的POC計算

并聯(lián)機構(gòu)的POC方程[22]為

(1)

(2)

式中MJi——第i個運動副的POC集

Mbi——第i條支鏈末端的POC集

MPa——機構(gòu)動平臺的POC集

m——運動副數(shù)

v——獨立回路數(shù)

靜平臺0與中間平臺1及3條Ci1Ri2Ri3(i=1,2,3)支鏈可看成一子并聯(lián)機構(gòu)。

確定中間平臺1的POC集為

即子并聯(lián)機構(gòu)可看成是1條三平移輸出的等效支鏈SOC{-P-P-P-}。

末端執(zhí)行件的POC集為

因此，機構(gòu)自由度為4，具有空間任意方向的移動和繞垂直于中間平臺1法線方向的轉(zhuǎn)動，與Quadrupteron機構(gòu)輸出特性相同。

1.2.2機構(gòu)的自由度計算

并聯(lián)機構(gòu)DOF公式[22]為

(3)

(4)

v=m-n+1

式中F——機構(gòu)自由度

fi——第i個運動副的自由度

n——構(gòu)件數(shù)

ξLj——第j個獨立回路的獨立位移方程數(shù)

Mb(j+1)——前j+1條支鏈末端構(gòu)件POC集

機構(gòu)所含的獨立回路數(shù)為

v=m-n+1=14-12+1=3

機構(gòu)的拓撲結(jié)構(gòu)路線可以分解為

SOC1{-C11‖R12‖R13-R23‖R22‖C21-}

SOC2{-C31‖R32‖R33-}

SOC3{-RD‖R44⊥R43‖R42‖C41-}

由式(4)得

其構(gòu)成子并聯(lián)機構(gòu)PM(1-2)的自由度和POC集為

由式(2)得

其子并聯(lián)機構(gòu)PM(1-3)的自由度和POC集為

由式(2)得

由式(3)得

因此，該降耦機構(gòu)的自由度仍為4，當取靜平臺0上C副的移動作為驅(qū)動副時，末端輸出件2可實現(xiàn)3個平移及1個轉(zhuǎn)動的運動輸出。

1.2.3機構(gòu)耦合度κ計算

由基于序單開鏈(Single open chain, SOC)的機構(gòu)組成原理[22]可知，任一機構(gòu)可分解為約束度為正、零、負的3種有序單開鏈(SOC)，第j個SOCj的約束度定義為

(5)

式中mj——第j個SOCj的運動副數(shù)

Ij——第j個SOCj的驅(qū)動副數(shù)

進一步，一組有序的v個SOC可組成一個零自由度的獨立回路數(shù)為v的基本運動鏈(Basic kinematics chain, BKC)，對一個BKC而言，須滿足

(6)

因此，BKC的耦合度為

(7)

已計算出機構(gòu)3個回路的獨立位移方程數(shù)，分別為ξL1=5,ξL2=4,ξL3=5，因此，由式(5)可得：

SOC1的約束度為

SOC2的約束度為

SOC3的約束度為

則SOC3構(gòu)成另一基本運動鏈BKC2，耦合度κ2=0。

1.2.4降耦機構(gòu)運動解耦性分析

對圖2所示的降耦機構(gòu)進行解耦性分析如下：

(1)降耦機構(gòu)可分解為2個BKC，如圖3所示。其中，BKC1由SOC1和SOC2構(gòu)成，即由靜平臺0、中間平臺1及其間的3條Ci1Ri2Ri3(i=1,2,3)支鏈組成；另一個BKC2由C41、R42、U43、RD組成。

圖3 降耦機構(gòu)的拓撲結(jié)構(gòu)組成Fig.3 Topological structure of decoupled PM

(2)由于機構(gòu)的4個驅(qū)動位于不同的BKC，滿足文獻[22]的并聯(lián)機構(gòu)解耦性準則條件，則降耦機構(gòu)具有部分自由度，即機構(gòu)輸出具有運動解耦。

(3)末端輸出件2的位姿取決于所有主驅(qū)動輸入，與其相鄰的中間平臺1(包括轉(zhuǎn)動副RD)的位姿取決于部分輸入；末端輸出件2與中間平臺1的平移運動重合，同時，末端件2繞轉(zhuǎn)動副RD相對于中間平臺1以角φ旋轉(zhuǎn)。

用同樣的方法，對Quadrupteron機構(gòu)進行了上述的拓撲結(jié)構(gòu)特征分析，分析結(jié)果如表1所示。

結(jié)果表明，降耦機構(gòu)的自由度、POC集與Quadrupteron相同，均為3T1R；但運動副數(shù)和構(gòu)件數(shù)均有所減小，故降耦機構(gòu)的結(jié)構(gòu)設(shè)計、制造更為簡單；從拓撲結(jié)構(gòu)組成來看，Quadrupteron由一個BKC組成，耦合度κ=2；而降耦機構(gòu)由兩個BKC組成，耦合度分別為1和0，且降耦機構(gòu)的輸出具有部分解耦性，表明降耦機構(gòu)的運動學(xué)正解及動力學(xué)分析的難度將會大大降低。

表1 兩種并聯(lián)機構(gòu)的拓撲結(jié)構(gòu)特征Tab.1 Topological structure characteristics of two PM

2 運動學(xué)分析

靜平臺采用框架形式，建立如圖4所示定坐標系Oxyz，z軸與C11軸線平行，x軸平行于C31軸線；θi1(i=1,2,3)分別為構(gòu)件A1B1與x軸、構(gòu)件A2B2與x軸、構(gòu)件A3B3與z軸的夾角；4個移動驅(qū)動滑塊分別安裝在間距為L的4個軌道上；驅(qū)動副行程為ρ，安裝中心分別記為Gi(i=1,2,3,4)；每個分支的定長桿AiBi及BiCi長度設(shè)為lij(i=1,2,3;j=1,2)。

圖4 并聯(lián)機構(gòu)運動示意圖Fig.4 Kinematic diagram

在中間平臺1的N點建立動坐標系Nuvw，v軸平行于轉(zhuǎn)動副R23軸線方向，w軸平行于中間平臺1的法線；點Ci(i=1,2,3)是轉(zhuǎn)動副Ri3(i=1,2,3)在中間平臺1上的安裝基點，其特征參數(shù)是r，且有|NCi|=r(i=1,2,3)，并設(shè)Ci在Nuvw坐標系下的位置矢量為ri，βi(i=1,2,3)為NCi與u軸的夾角，如圖5所示。

圖5 中間平臺1上運動副的分布Fig.5 Distribution of pairs on moving platform-1

圖6 基本運動鏈BKC2示意圖Fig.6 Sketch of BKC2

基本運動鏈BKC2的結(jié)構(gòu)如圖6所示，θ41為構(gòu)件A4B4與x軸的夾角；定長桿A4B4及B4C4桿長分別為l41、l42；末端輸出件C4D長度為l。

設(shè)驅(qū)動副的輸入變量為ρ=(ρ1,ρ2,ρ3,ρ4)，末端輸出件基點D位姿為x=(xD,yD,zD,φ)，則4條支鏈存在以下關(guān)系：

支鏈1

(8)

支鏈2

(9)

支鏈3

(10)

C4坐標滿足如下關(guān)系

(11)

式中h——轉(zhuǎn)動副安裝基點D與點N距離，見圖6

則由式(8)～(11)，可得

ρ2-rsinβ2=ρ4-lsinφ

(12)

2.1 機構(gòu)位置正解

已知機構(gòu)的輸入位移(ρ1,ρ2,ρ3,ρ4)，求末端輸出點D的位姿(xD,yD,zD,φ)，即為位置正解。

由式(8)～(12)，有

(13)

sinφ=(ρ4-ρ2+rsinβ2)/l

(14)

解式(14)，可得：

(1)當|ρ4-ρ2+rsinβ2|/l<1時，φ有兩組解

φ1=arcsin(|ρ4-ρ2+rsinβ2|/l)

(15)

φ2=arcsin(|ρ4-ρ2+rsinβ2|/l)+π

(16)

(2)當|ρ4-ρ2+rsinβ2|/l=1時，φ有一組解。

(3)當|ρ4-ρ2+rsinβ2|/l>1時，φ無解。

分析表明，對于給定的、非奇異輸入，末端執(zhí)行件有兩組姿態(tài)；而當初始裝配情形確定后，機構(gòu)的運動學(xué)正解具有唯一性。

2.2 機構(gòu)位置反解

已知末端輸出基點D的位姿(xD,yD,zD,φ),求機構(gòu)的輸入位移(ρ1,ρ2,ρ3,ρ4)，即為位置反解。

由式(13)、(14)可直接得出機構(gòu)反解方程為

(17)

對式(13)、(14)整理，可得末端基點的輸出矩陣形式為

(18)

式中 ·——輸出常數(shù)

fi(·)——結(jié)構(gòu)參數(shù)構(gòu)成的函數(shù)

由式(18)可知，該機構(gòu)的解耦性具有兩層含義：①末端輸出件的位置與姿態(tài)具有拓撲解耦特性。②末端輸出的移動本身具有解耦特性，且具有各向同性，這為控制帶來了方便。

3 機構(gòu)雅可比矩陣及奇異性分析

3.1 機構(gòu)雅可比矩陣

將式(17)對時間t求導(dǎo)，整理得

(19)

用矩陣A和B來分析機構(gòu)奇異特性，并記J=A-1B為機構(gòu)的雅可比矩陣。

3.2 奇異性分析

并聯(lián)機構(gòu)接近或到達奇異位形時，動平臺將變得不可控?；跈C構(gòu)的雅可比矩陣，GOSSELIN等[23]將并聯(lián)機構(gòu)的奇異位形分為3類：正解奇異、反解奇異及混合奇異。發(fā)生正解奇異的條件是：|B|=0、|A|≠0，此時即使驅(qū)動副固定，機構(gòu)末端仍能運動；當|A|=0、|B|≠0時，機構(gòu)出現(xiàn)反解奇異，在發(fā)生反解奇異時，末端執(zhí)行元件會失去一個或多個自由度；當正解奇異和反解奇異同時發(fā)生時，發(fā)生混合奇異。

對于(3CRR/R)&CRRR降耦并聯(lián)機構(gòu)來說，奇異分析包括兩部分：①BKC1奇異，即靜平臺0、中間平臺1及3條Ci1Ri2Ri3(i=1,2,3)支鏈組成子并聯(lián)機構(gòu)部分的奇異。②BKC1和BKC2組成的3回路(記為：BKC1+BKC2)機構(gòu)的奇異。

3.2.1BKC1奇異分析

由式(19)前3項可知，三平移輸出子并聯(lián)機構(gòu)的雅可比矩陣為正交單位矩陣，不存在正解奇異；對反解奇異，當每條Ci1Ri2Ri3(i=1,2,3)支鏈的3個運動副軸線共面時發(fā)生，屬于工作空間的邊界奇異。因此，解耦3CRR子并聯(lián)機構(gòu)在全工作空間內(nèi)部不存在奇異位形。

3.2.2BKC1+BKC2奇異分析

(1)反解奇異

由式(19)可知，A是單常數(shù)陣，|A|恒不等于0，故不存在反解奇異。

(2)正解奇異

由|B|=0可得

cosφ=0

(20)

式(20)有兩組解，即φ=π/2、φ=-π/2。這2個奇異姿態(tài)將降耦機構(gòu)的工作空間分為2個無奇異工作空間區(qū)域：① 無奇異區(qū)域Ⅰ(-π/2<φ<π/2)，此時cosφ>0。② 無奇異區(qū)域Ⅱ (π/2<φ<3π/2)，此時cosφ<0。

只要機構(gòu)遠離這2個姿態(tài)(φ=π/2和φ=-π/2)，則機構(gòu)不會發(fā)生反解奇異。

(3)混合奇異

由于|A|=0及|B|=0不可能同時成立，故機構(gòu)不存在混合奇異位形。

3.2.3無奇異工作空間內(nèi)運動學(xué)正解的分布

以上分析可知，機構(gòu)無奇異工作空間包括：無奇異區(qū)域Ⅰ和無奇異區(qū)域Ⅱ；而運動學(xué)正解分析表明，機構(gòu)存在兩組運動學(xué)正解。根據(jù)式(15)、(16)、(20)可知，機構(gòu)運動學(xué)正解的2個公式分別對應(yīng)機構(gòu)的無奇異工作空間區(qū)域Ⅰ和Ⅱ，如表2所示。

表2 機構(gòu)無奇異工作空間區(qū)域內(nèi)運動學(xué)正解Tab.2 Forward kinematics among singularity-free workspace

一旦機構(gòu)裝配形式給定，則確定了機構(gòu)的無奇異工作區(qū)域，根據(jù)表2的計算公式可直接計算出機構(gòu)的唯一運動學(xué)正解。

圖4所示構(gòu)型處于無奇異工作區(qū)域Ⅰ，則可采用式(13)、(15)進行運動學(xué)正解求解，這進一步簡化了機構(gòu)的運動學(xué)正解分析過程。

4 工作空間分析

對于3T1R并聯(lián)機構(gòu)，通常研究定姿態(tài)工作空間和可達工作空間。定姿態(tài)工作空間為機構(gòu)動平臺姿態(tài)保持一定時，動平臺上參考點所能到達的區(qū)域；可達工作空間，是動平臺上參考點以至少任一姿態(tài)能夠到達的點的集合。

對大多數(shù)3T1R并聯(lián)機構(gòu)而言，動平臺不同的姿態(tài)對應(yīng)的工作空間大小不同，且相差較大。

由式(13)可知，本文提出的降耦并聯(lián)機構(gòu)，末端執(zhí)行件3個方向的平移運動只與機構(gòu)3個方向的驅(qū)動輸入?yún)?shù)分別相關(guān)，與姿態(tài)角φ無關(guān)，故下文直接討論機構(gòu)的可達工作空間。

4.1 可達工作空間

式(13)表明，機構(gòu)可達工作空間是3個方向圓柱體相貫形成的一個空間幾何體[20]，每個圓柱體的外徑等于對應(yīng)支鏈的兩定長桿桿長之和|li1+li2|，而內(nèi)徑等于兩桿桿長之差|li1-li2|。假設(shè)，保持支鏈定長桿長度不變，且li1=li2=1(無量綱)，驅(qū)動副行程范圍為ρ，令λ=ρ/|li1+li2|；并合理定位基座上移動副的驅(qū)動位置，以保證空間3個圓柱體相交體積最大化，則工作空間形狀及大小隨驅(qū)動副行程的變化情況如表3所示。

由表3可知，工作空間隨λ的增大先增加后保持不變，整個工作空間形狀規(guī)則，且無內(nèi)部空洞；當λ≤1時，工作空間是邊長為ρ的立方體；當λ>1時，工作空間形狀為一多面體；當λ>1.675時，工作空間形狀和體積均保持不變。因此，為使機構(gòu)結(jié)構(gòu)緊湊、且獲得規(guī)則形狀的較大工作空間，驅(qū)動副行程不超過支鏈兩定長桿長度之和。

表3驅(qū)動副行程對工作空間體積的影響
Tab.3Influenceofdrivingstrokeonworkspace

4.2 轉(zhuǎn)動能力分析

由式(14)可知，末端機構(gòu)的轉(zhuǎn)動姿態(tài)僅僅決定于2個輸入?yún)?shù)ρ2和ρ4，如保持ρ2、ρ4的驅(qū)動關(guān)系不變，可達工作空間內(nèi)每一位置轉(zhuǎn)動能力均相同；且每一位置的無奇異轉(zhuǎn)動范圍均為：φ∈(-π/2,π/2)或φ∈(π/2,3π/2)。

目前研究的文獻中，除采用特殊的放大機構(gòu)外，大多數(shù)3T1R并聯(lián)機構(gòu)的轉(zhuǎn)動范圍均在[-90°,90°]之內(nèi)，且工作空間內(nèi)點的轉(zhuǎn)動能力差異較大。

5 算例

為便于性能比較，參照Quadrupteron樣機結(jié)構(gòu)參數(shù)，機構(gòu)主要尺寸參數(shù)如表4所示[20]。增加的末端執(zhí)行件C4D的長度為40 mm，移動副驅(qū)動行程為220 mm，機構(gòu)三維虛擬裝配如圖7所示。

5.1 運動學(xué)正反解算例

由圖7可知，該裝配形式使得機構(gòu)總工作在無奇異區(qū)域Ⅰ，給定兩組主動輸入?yún)?shù)：①ρ1=0，ρ2=0，ρ3=0，ρ4=0；②ρ1=10，ρ2=40，ρ3=30，ρ4=20。運用式(15)、(13)，求得對應(yīng)的實數(shù)正解，如表5中序號①和②所示。

表4 機構(gòu)的幾何參數(shù)Tab.4 Geometric parameters of mechanism mm

圖7 降耦并聯(lián)機構(gòu)的CAD模型Fig.7 CAD model of decoupled parallel mechanism

將表5中①、②正解數(shù)據(jù)，代入反解式(17)中，可得實數(shù)反解(序號③和④)。它與上述給定的輸入?yún)?shù)一致，故認為正反解求解正確。

表5 (3CRR/R)&CRRR機構(gòu)位姿正反解算例Tab.5 Positive and inverse solution example of(3CRR/R)&CRRR

5.2 工作空間及轉(zhuǎn)動能力分析

由4.1節(jié)和4.2節(jié)分析可知，不考慮機構(gòu)約束時，機構(gòu)可達工作空間是一規(guī)則立方體，邊長為驅(qū)動副行程，即機構(gòu)工作空間是邊長為220 mm的立方體，且工作空間內(nèi)每一位置的轉(zhuǎn)動能力均一致，為(-90°,90°)，且無內(nèi)部奇異。

由于各被動關(guān)節(jié)轉(zhuǎn)角限制以及桿件可能發(fā)生干涉，實際工作空間小很多。本文基于位置反解式(17)，采用搜索法求解出滿足約束條件的所有點，再利用所有滿足約束條件的“點集”近似求解出工作空間體積。求解步驟如下：

(1)根據(jù)經(jīng)驗初步估算出工作空間的搜索范圍為：35 mm≤XD≤315 mm，31 mm≤YD≤365 mm，0≤ZD≤270 mm。

(2)基于位置反解式(17)求解并聯(lián)機構(gòu)的輸入?yún)?shù)(ρ1,ρ2,ρ3,ρ4)，同時滿足如下約束條件：①支鏈各被動關(guān)節(jié)的轉(zhuǎn)角必須限制一定范圍：-75°≤θi1≤75°，15°≤θi2≤165° (i=1,2,3)。②驅(qū)動副行程為220 mm。③根據(jù)奇異條件，末端輸出件2的轉(zhuǎn)動姿態(tài)必須滿足(-90°,90°)。

(3)給定末端輸出件姿態(tài)角φ，并將步驟(1)中的初始化輸出參數(shù)代入反解式(17)中。

(4)選取搜索步長因子Δx=Δy=Δz=10 mm，若通過步驟(1)～(3)計算的結(jié)果滿足所有約束條件，則為工作空間內(nèi)有效點，否則返回步驟(1)，并按步長依次改變末端件的輸出位置參數(shù)。

根據(jù)表4給定的機構(gòu)參數(shù)，在Matlab中編程計算，求解給定姿態(tài)φ下的“點數(shù)”nφ，而每個點可視為邊長為Δx的小正方體。因此，可求得定姿態(tài)下工作空間體積為(單位：mm3)

Vφ=nφ(Δx)3=103nφ

(21)

采用同樣的步驟，對Quadrupteron機構(gòu)的定姿態(tài)工作空間體積進行計算。圖8是不考慮轉(zhuǎn)動關(guān)節(jié)角度限制時，(3CRR/R)&CRRR降耦機構(gòu)和Quadrupteron[20]的Vφ與φ的關(guān)系曲線。

圖8 定姿態(tài)工作空間體積隨φ的變化(不考慮約束)Fig.8 Changes of Vφ with φ (without constraints)

由圖8可知：①對(3CRR/R)&CRRR降耦機構(gòu)，全工作空間轉(zhuǎn)動能力保持不變，即工作空間內(nèi)所有位置點的轉(zhuǎn)動能力一致，工作空間體積達1.11×107mm3。②對于Quadrupteron機構(gòu)，在姿態(tài)角為0°時，定姿態(tài)工作空間體積達最大，Vφmax=8.33×106mm3；當姿態(tài)角接近±90°時，定姿態(tài)工作空間體積最小，Vφmin=4.95×106mm3；其最小、最大工作空間體積降幅達40%以上，與文獻[21]的結(jié)論一致。因此，降耦機構(gòu)的定姿態(tài)工作空間體積及轉(zhuǎn)動能力較Quadrupteron并聯(lián)機構(gòu)都有顯著提升。

5.3 降耦機構(gòu)的實際定姿態(tài)工作空間

圖9是考慮轉(zhuǎn)動副角度范圍限制時，降耦機構(gòu)(3CRR/R)&CRRR定姿態(tài)工作空間體積隨末端輸出姿態(tài)φ的變化情況。由圖9可知：①考慮運動副轉(zhuǎn)角范圍限制后，降耦機構(gòu)實際定姿態(tài)工作空間體積有所減小，可見，合理設(shè)計被動關(guān)節(jié)的安裝角，可提高并聯(lián)機構(gòu)的工作空間。②降耦機構(gòu)在初始姿態(tài)，即φ=0時，定姿態(tài)工作空間體積達最大，約為9.398×106mm3；隨著姿態(tài)角的增加，定姿態(tài)工作空間體積減??；當轉(zhuǎn)角接近±90°時，定姿態(tài)工作空間體積最小，為6.519×106mm3。故在考慮轉(zhuǎn)動約束的情況下，降耦機構(gòu)定姿態(tài)工作空間體積的最大降幅達30%，小于Quadrupteron在理想狀態(tài)下最小、最大工作空間的降幅(大于40%)。這進一步表明，考慮轉(zhuǎn)動副角度范圍限制時，降耦機構(gòu)的實際定姿態(tài)工作空間比Quadrupteron機構(gòu)有較大改善。

圖9 (3CRR/R)&CRRR機構(gòu)的Vφ與φ關(guān)系曲線(考慮約束)Fig.9 Relationship curve between Vφ with φ(with constraints)

6 結(jié)論

(1)通過運動副復(fù)合的方法，對Quadrupteron并聯(lián)機構(gòu)進行降耦設(shè)計，提出了一種耦合度較低的3T1R新機型。

(2)該降耦機構(gòu)具有輸出運動解耦特性，機構(gòu)3個方向的移動輸出與3個輸入?yún)?shù)一一對應(yīng)，而轉(zhuǎn)動姿態(tài)與其中2個輸入?yún)?shù)相關(guān)。

(3)機構(gòu)結(jié)構(gòu)簡單、運動學(xué)正反解方程更簡單，方便制造、控制。

(4)在(-90°,90°)輸出轉(zhuǎn)角范圍內(nèi)，機構(gòu)無內(nèi)部奇異存在；且機構(gòu)具有較大體積的規(guī)則工作空間，全工作空間內(nèi)所有位置的轉(zhuǎn)動能力一致。

(5)該降耦機構(gòu)克服了一般并聯(lián)機構(gòu)耦合性強、控制復(fù)雜的弱點，轉(zhuǎn)動能力大幅度提高，具有較好的工業(yè)應(yīng)用前景。