邵國為

（常州紡織服裝職業(yè)技術(shù)學(xué)院， 江蘇常州 213016）

0 引言

近幾年， 學(xué)者們對四自由度或五自由度并聯(lián)機(jī)構(gòu)進(jìn)行了大量的結(jié)構(gòu)綜合研究，并確定了其運(yùn)動的可行性。眾所周知， 具有Sch?nflies 運(yùn)動的機(jī)器人 （也稱為SCARA運(yùn)動或3T1R 運(yùn)動）可用于各種工業(yè)任務(wù)，如取放、裝配、包裝和噴漆等。 但相對于三平移的Delta 機(jī)構(gòu)[1-4]要更加的復(fù)雜，而相較于六自由度并聯(lián)機(jī)器人，隨著3T1R 型并聯(lián)機(jī)構(gòu)運(yùn)動學(xué)等分析支鏈數(shù)的減少， 并聯(lián)機(jī)構(gòu)的工作空間增大，奇異構(gòu)型減少。 因此有必要對3T1R 型并聯(lián)機(jī)構(gòu)進(jìn)行理論研究。

Delta 并聯(lián)機(jī)構(gòu)構(gòu)型綜合后，相關(guān)學(xué)者對其位置求解問題展開了廣泛的研究[5-7]。 已知Delta 型并聯(lián)機(jī)構(gòu)輸入，求輸出的問題的解決方法（正解）有兩種：解析法和數(shù)字法。 Romdhane[8]采用解析方法，對一類3 自由度機(jī)構(gòu)的正解進(jìn)行了計算， 并得出了輸入與輸出之間的位置關(guān)系方程。 趙杰等[9]運(yùn)用幾何和向量代數(shù)的方法，實現(xiàn)Delta 機(jī)構(gòu)運(yùn)動學(xué)正解的快速、直觀的推導(dǎo)，避免了并聯(lián)機(jī)構(gòu)運(yùn)動學(xué)多正解選擇的難題。 張利敏[10]對其進(jìn)行了深入研究，并給出了相應(yīng)的運(yùn)動學(xué)模型。 對于一些較為復(fù)雜的并聯(lián)機(jī)構(gòu)，其正解通常是不能得到的，所以常用的算法是牛頓迭代算法，但是這些算法得到的結(jié)果并不包括全部的結(jié)果，選擇起來也很麻煩。

在3T1R 并聯(lián)機(jī)構(gòu)的運(yùn)動分析方面，Mahboubkhah[11]等提出了一種可用于加工的高剛度并聯(lián)機(jī)構(gòu)。 Wu 等[12]采用幾何投影法，同時運(yùn)用閉環(huán)矢量法對具有3T1R 運(yùn)動的4PPa-2PaR 并聯(lián)機(jī)構(gòu)進(jìn)行瞬時運(yùn)動分析。Li 等[13]利用組態(tài)演繹法設(shè)計了一種創(chuàng)新的3T1R 并聯(lián)機(jī)構(gòu)，并對其位置進(jìn)行了深入分析。 Zhang 等[14]提出了一種通用的解決方案，用于求解3T1R 過約束并聯(lián)機(jī)構(gòu)雅可比矩陣和約束海塞矩陣的統(tǒng)一公式。

本文提出一種基于方位特征集的V-2RPa⊥R⊕2RSS并聯(lián)機(jī)構(gòu)運(yùn)動學(xué)分析設(shè)計方法。 在此基礎(chǔ)上，利用一維搜尋法，構(gòu)建一種只有1 個虛擬變量的方位一致性模型，基于直角坐標(biāo)法， 從而方便地給出了該正解的一個解析式，并給出了逆解求解結(jié)果來證明該正解的正確性。這為優(yōu)化并聯(lián)機(jī)構(gòu)的參數(shù)以及研發(fā)原型機(jī)提供了一些理論支持。

1 機(jī)構(gòu)結(jié)構(gòu)分析

1.1 機(jī)構(gòu)描述

參照圖1，該機(jī)械裝置包含了一個運(yùn)動平臺1 （位于圖1 底部方框內(nèi)） ，一個靜止平臺0，兩個RSS 支臂和兩個V 型方位布置的混合支臂V-2RPa⊥R。 兩個混合支臂均是由四個球狀（球副）連接點（Sa，Sb，Sc，Sd）形成的一個平行四邊形組成，我們稱之為Pa 部分（即“parallel”）。

圖1 V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)及位置求解模型

兩個由（Ra、Rb）的組成的桿安裝在Pa 部件中平行四邊形結(jié)構(gòu)中間位置，平臺1 上R3的軸必須與靜平臺0 垂直，從而得到3T1R 輸出的混合支鏈V-2RPa⊥R。 靜止平臺0 上的4 個驅(qū)動副R11｜｜R21、R31⊥R41，其中，R31與R41呈V 型布置。 動平臺1 能夠進(jìn)行三移動和繞R3 軸線旋轉(zhuǎn)（3T1R）運(yùn)動。

1.2 計算耦合度κ

（1）確定混合支鏈HSOC1及其約束度△1。

由文獻(xiàn)[15]，HSOC1有兩種選擇方案：

①若選V-2RPa⊥R 支鏈構(gòu)成HSOC1，即

HSOC1{R31｜｜P（4s）-P（4s）-R（4s）-P（4s）-P（4s）-R（4s）｜｜R41⊥R3-S13-S12-R11-}

由文獻(xiàn)[15]有

②若2RSS 構(gòu)成SOC1，即

SOC1{-R11-S12-S13-S23-S22-R21-}

則

應(yīng)選擇方案①

（2）確定及其約束度

SOC2由支鏈R21S22S23組成，即

SOC2{-S23-S22-R21-}

由式（1）有

（3）由此可得

結(jié)構(gòu)只包含一個BKC，其耦合程度為1，能夠獲得所有的數(shù)值解[15]。

2 位置分析

2.1 位置正解分析

2.1.1 坐標(biāo)系建立及符號標(biāo)注

V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)的正解問題可表示為：給定主動桿的輸入?yún)?shù)α1，β1，γ1，δ1， 求解末端執(zhí)行件1（動平臺1）的輸出參數(shù)（x，y，z）（三平移）和γ（一轉(zhuǎn)動）。

如圖1 所示， 直角坐標(biāo)系統(tǒng)O-XYZ 的OX 與OY 軸均位于靜態(tài)臺的中心位置，該系統(tǒng)的X 軸、Y 軸及Z 軸分別對應(yīng)于一條固定的線段，且通過使用右手定律來定義Z 軸。動坐標(biāo)系統(tǒng)O'-X'Y'Z'的原點設(shè)在了S13S23的中部，當(dāng)動平臺開始移動時，X'軸、Y'軸和Z'軸沿著相應(yīng)的方向運(yùn)動。

圖2 為V-2RPa⊥R⊕2RSS 機(jī)構(gòu)展開圖，靜態(tài)平臺長度設(shè)定為2a，寬度2b，而（末端執(zhí)行平臺）動態(tài)平臺1 是一個等腰直角三角形，其邊長為2m2。

圖2 V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)展開圖

動平臺1 圍繞旋轉(zhuǎn)副R3的旋轉(zhuǎn)角度是動平臺1 的輸出姿態(tài)角γ，可表示為S13O'與OX 軸的所夾銳角，逆時針取正。

設(shè)定R3與B3的連接長度為q1，Ba與Bb連接長度為l，初始位置時，Ba和Bb的連線與Sa和Sb的連線、Sa1和Sb1的連線的夾角均為φ，此時設(shè)定R11與S12的連線，R21與S22的連線長度均為la1，S12與S13的連線長度、S22與S23的連線長度均為lb1；R31與P3的連線長度、R41與P4的連線長度均為la，P3與Ba的連線長度、P4與Bb的連線長度均為lb。

根據(jù)圖1 和圖3，Ш 和Ⅳ分支的輸入角分別為R31與P3的連線（la）與XOY 平面的夾角（α1）以及R41與P4的連線（lb）與XOY 平面的夾角 （β1）， 兩個Pa 部分的平面分別與XOY 平面之間的夾角分別是α2，β2，Pa 部分的內(nèi)夾角銳角分別為α3，β3，設(shè)定逆時針方向為正。

圖3 III 支鏈與IV 支鏈的運(yùn)動位置模型

I、 II 分支的主動輸入角度是γ1，δ1，以相對于靜坐標(biāo)系OXY 的X、Y、Z軸線的角度來代表連接桿S13S12、S23S22在空間中的位置； 也就是γ2，γ3，γ4以及γ5，γ6，γ7的角度，見圖4。

圖4 I、II 支鏈計算模型

2.1.2 基于SOC 的位置建模分析

2.1.2.1 在△1＞0 的條件下對HSOC1的運(yùn)動位置建模

（1）由HSOC1（III、IV）支鏈，分別可得O’坐標(biāo)值

由式（1）、（2）可得，

β3為中間值，可以消除，首先令

從而得到

解方程可得：

（2）由第一條支鏈（I 支鏈），得到R11S12S13支鏈上球副S12、S13點的坐標(biāo)為：

進(jìn)一步，由S12與S13兩點之間的長度等于lb1，有

A1sinγ+B1cosγ+C1=0其中，

令

解之有：

得到輸出角（γ*）的函數(shù)表達(dá)式，同樣也是一個關(guān)于α3*的函數(shù)

即γ*=f2（α3*）

2.1.2.2 在△2＜0 條件下的SOC2支鏈運(yùn)動位置數(shù)學(xué)模型

由II 支鏈，得R21S22S23支鏈中的球副S22、S23點坐標(biāo)為：

進(jìn)一步，由S22與S23兩點之間連線的長度等于S12與S13兩點之間連線的長度，均為，建立其支鏈II 的位置方程，即

設(shè)定變量α3*在（0°，360°）范圍內(nèi)改變數(shù)值，在滿足f（）=0 的情況下，即可求解對應(yīng)α3的數(shù)值解，由式（2）、（4）、（5）即可求得動平臺位置解o'（x，y，z）；代入式（7），即可求得動平臺繞Z 軸旋轉(zhuǎn)角度γ。

2.2 位置反解求解

V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)的反解問題可描述為：給定動平臺1（末端執(zhí)行器）的位置、姿態(tài)參數(shù)（x，y，z）（三平移）和γ（一轉(zhuǎn)動），求解主動桿相對于XOY 平面的輸入角度參數(shù)α1，β1，γ1，δ1。

2.2.1 基于直角坐標(biāo)法求V-2RPa⊥R⊕2RSS 機(jī)構(gòu)中各位置坐標(biāo)

由2.1.2 可知，

Ba點在靜坐標(biāo)下矢量方程

Ba點在靜坐標(biāo)下矢量方程

則S13的絕對坐標(biāo)為：

即

同理可得R21S22S23支鏈中的球副S23的在靜平臺坐標(biāo)系O-XYZ 下的坐標(biāo)為：

2.2.2 建立位置方程

根據(jù)連桿約束條件可得：

2.2.3 求輸入角α1，β1，γ1，δ1

由（14）式可得R31Pa⊥R3支鏈主動輸入角α1：

其中，A1=2（z-q1）la

由式（15）可得R41Pa⊥R3支鏈主動輸入角β1：

其中，A2=2（z-q1）la

由式（16）可得R11S12S13支鏈主動輸入角γ1：

其中，A3=-2zla

由式（17）可得R21S22S23支鏈主動輸入角δ1：

其中，A4=-2zla

當(dāng)輸出參數(shù)和已知時，α1，β1，γ1，δ1分別有兩組解。 故位置逆解數(shù)為2×2×2×2=16， 因此，V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)動平臺可輸出有16 種構(gòu)型。

2.3 實例驗算

2.3.1 正解算例

因V-2RPa⊥R⊕2RSS 機(jī)構(gòu)與H4（I4R）均含有Pa 復(fù)雜支鏈，為便于后續(xù)性能對比，取與產(chǎn)業(yè)用H4 并聯(lián)機(jī)構(gòu)相同的尺寸，即，

令相應(yīng)桿長尺寸數(shù)據(jù)為：la=375，lb=800，la1=375，lb1=880，a=400，b=400，m2=200； 其余還參數(shù)包括：l=350mm，q1=40mm，φ=45°。 對主動桿輸入角進(jìn)行賦值，

依據(jù)式（1）～式（9），通過使用一維搜尋方法[15]，可以從兩組角度中得到V-2RPa⊥R⊕2RSS 機(jī)構(gòu)末端執(zhí)行器的四個位置，如表1 所示。

表1 V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)的末端位置

2.3.2 逆解算例

3 樣機(jī)CAD 建模

圖5 展示了V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)的虛擬樣品設(shè)計總圖，其中包括靜態(tài)平臺0、動態(tài)平臺1、動態(tài)平臺2、RSS 支鏈3、復(fù)雜支鏈（含Pa）4 和驅(qū)動系統(tǒng)5 這六個主要部分。

圖5 V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)的虛擬樣機(jī)圖

3.1 支鏈設(shè)計

V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)由四條支鏈并聯(lián)耦合而成， 為動平臺傳遞運(yùn)動、末端執(zhí)行件承受載荷，支鏈的結(jié)構(gòu)須在滿足工況的前提下，質(zhì)量盡量輕。 因此，四個支鏈中的主動臂和從動臂都使用了碳纖維編織管狀結(jié)構(gòu)， 這種結(jié)構(gòu)具有輕量化、高強(qiáng)度和高模型等優(yōu)點。RSS 支鏈與復(fù)雜支鏈（含Pa）的3D 結(jié)構(gòu)如圖6 所示。

圖6 支鏈結(jié)構(gòu)圖

3.2 動、靜平臺的設(shè)計

子動平臺1和子動平臺2是相互垂直并且通過轉(zhuǎn)動副連接，進(jìn)而實現(xiàn)V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)末端的繞Z 軸的旋轉(zhuǎn)運(yùn)動，同時通過球關(guān)節(jié)（S13 或S23）分別連接兩個RSS 支鏈，從而構(gòu)成了可實現(xiàn)三平移一轉(zhuǎn)動輸出運(yùn)動的V-2RPa⊥R⊕2RSS 機(jī)構(gòu)的結(jié)構(gòu)。同時，該并聯(lián)機(jī)構(gòu)的靜平臺0 安裝有4 塊電機(jī)安裝板，4 臺伺服電機(jī)，結(jié)構(gòu)如圖7 所示。

圖7 靜平臺結(jié)構(gòu)設(shè)計

4 結(jié)論

提出了一種四自由度V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)， 結(jié)構(gòu)比H4、I4R 機(jī)構(gòu)更為簡單、動平臺裝配結(jié)構(gòu)更為容易。

利用一維搜索計算出了V-2RPa⊥R⊕2RSS 并聯(lián)機(jī)構(gòu)的耦合度，并得到四組機(jī)構(gòu)末端位置數(shù)值解。進(jìn)一步求解后，我們得出了機(jī)構(gòu)位置反解的解析式。

這個結(jié)構(gòu)設(shè)計簡潔，為后期的動力學(xué)分析奠定了基礎(chǔ)。