陳修龍 郭景堯 賈永皓

(山東科技大學(xué)機(jī)械電子工程學(xué)院， 青島 266590)

0 引言

并聯(lián)機(jī)構(gòu)相比于串聯(lián)機(jī)構(gòu)具有剛度大、精度高、承載能力強(qiáng)等優(yōu)點(diǎn)，但由于并聯(lián)機(jī)構(gòu)奇異點(diǎn)的影響，使其優(yōu)勢(shì)難以發(fā)揮[1-4]。具有冗余結(jié)構(gòu)的并聯(lián)機(jī)構(gòu)可以避免并聯(lián)機(jī)構(gòu)的奇異位型，提高并聯(lián)機(jī)構(gòu)的剛度，在一定程度上提高了并聯(lián)機(jī)構(gòu)的運(yùn)動(dòng)性能，因此受到研究者的廣泛關(guān)注[5-7]。結(jié)構(gòu)冗余并聯(lián)機(jī)構(gòu)通過(guò)構(gòu)型的優(yōu)勢(shì)彌補(bǔ)了普通并聯(lián)機(jī)構(gòu)的不足，因此，對(duì)結(jié)構(gòu)冗余并聯(lián)機(jī)構(gòu)的研究具有重要意義。

并聯(lián)機(jī)構(gòu)的剛體動(dòng)力學(xué)建模是實(shí)現(xiàn)動(dòng)力學(xué)控制和研究機(jī)構(gòu)性能的前提，是在機(jī)構(gòu)運(yùn)動(dòng)學(xué)的基礎(chǔ)上對(duì)并聯(lián)機(jī)構(gòu)的進(jìn)一步研究與探索[8-11]，可為并聯(lián)機(jī)構(gòu)驅(qū)動(dòng)電機(jī)的選擇、控制和實(shí)際機(jī)構(gòu)的研制奠定理論基礎(chǔ)，同時(shí)為其他結(jié)構(gòu)冗余并聯(lián)機(jī)構(gòu)的剛體動(dòng)力學(xué)建模提供可行的思路。近年來(lái)，國(guó)內(nèi)外學(xué)者采用不同的方法對(duì)并聯(lián)機(jī)構(gòu)動(dòng)力學(xué)模型進(jìn)行了大量研究，但針對(duì)具有冗余結(jié)構(gòu)的并聯(lián)機(jī)構(gòu)研究較少。劉芳華等[12]基于拉格朗日動(dòng)力學(xué)模型，建立了6-UPS并聯(lián)平臺(tái)的全動(dòng)力學(xué)模型，并求解了理想驅(qū)動(dòng)力和時(shí)間的關(guān)系。XIN等[13]以三自由度空間并聯(lián)機(jī)器人為例，利用拉格朗日與虛功原理相結(jié)合的方法建立了動(dòng)力學(xué)模型，并通過(guò)仿真和實(shí)驗(yàn)加以證明。桑董輝等[14]提出了一種新型的二自由度球面并聯(lián)機(jī)構(gòu)，利用牛頓-歐拉法建立了動(dòng)力學(xué)方程，并在給定外力的作用下計(jì)算了關(guān)節(jié)作用力和作用力矩。王英波等[15]利用凱恩法建立了Stewart平臺(tái)的剛體動(dòng)力學(xué)模型，并利用動(dòng)力學(xué)建模仿真驗(yàn)證了其動(dòng)力學(xué)模型的正確性。陳修龍等[16]采用牛頓-歐拉法和虛擬仿真相結(jié)合的方法對(duì)4-UPS-RPS空間并聯(lián)機(jī)構(gòu)進(jìn)行了動(dòng)力學(xué)分析。ABDELLATIF等[17]利用拉格朗日公式和廣義坐標(biāo)重新推導(dǎo)了動(dòng)力學(xué)方程，驗(yàn)證了坐標(biāo)選取形式的重要性。朱偉等[18]以一種新型四自由度高速并聯(lián)機(jī)構(gòu)為例，運(yùn)用虛功原理建立了動(dòng)力學(xué)方程，并通過(guò)ADAMS虛擬仿真進(jìn)行了驗(yàn)證。GOSSELIN等[19]介紹了一種具有冗余結(jié)構(gòu)的并聯(lián)機(jī)構(gòu)，并證明該機(jī)構(gòu)所有奇異點(diǎn)都可通過(guò)運(yùn)動(dòng)學(xué)冗余來(lái)避免。ABADI等[20]證明了結(jié)構(gòu)冗余是避免奇異點(diǎn)和增大工作空間的有效途徑，并提出了一種新的運(yùn)動(dòng)規(guī)劃策略，以避免奇異點(diǎn)的產(chǎn)生。QU等[21]提出了一種平面結(jié)構(gòu)冗余并聯(lián)機(jī)構(gòu)，并通過(guò)靜力學(xué)仿真預(yù)測(cè)了機(jī)構(gòu)中較為容易損壞的位置。

本文以具有冗余結(jié)構(gòu)的3-RRPaR空間并聯(lián)機(jī)構(gòu)為研究對(duì)象，考慮其冗余構(gòu)型的影響，利用拉格朗日乘子法建立該并聯(lián)機(jī)構(gòu)的剛體動(dòng)力學(xué)模型。首先，分析3-RRPaR空間并聯(lián)機(jī)構(gòu)的結(jié)構(gòu)特征，計(jì)算機(jī)構(gòu)整體自由度；然后，利用閉環(huán)矢量法建立并聯(lián)機(jī)構(gòu)的運(yùn)動(dòng)學(xué)模型，求解出驅(qū)動(dòng)桿的角位移、角速度和角加速度；采用質(zhì)心坐標(biāo)和自然坐標(biāo)相結(jié)合的方式建立系統(tǒng)約束方程，計(jì)算機(jī)構(gòu)整體的質(zhì)量矩陣，利用拉格朗日乘子法建立并聯(lián)機(jī)構(gòu)的動(dòng)力學(xué)方程，并根據(jù)拉格朗日乘子與約束力矩的關(guān)系求解驅(qū)動(dòng)力矩；最后，利用Matlab對(duì)動(dòng)力學(xué)方程進(jìn)行數(shù)值求解，將理論模型求解結(jié)果與ADAMS虛擬仿真結(jié)果進(jìn)行對(duì)比，分析并聯(lián)機(jī)構(gòu)動(dòng)力學(xué)響應(yīng)曲線。

1 結(jié)構(gòu)特征

3-RRPaR空間并聯(lián)機(jī)構(gòu)如圖1所示。該并聯(lián)機(jī)構(gòu)由定平臺(tái)、動(dòng)平臺(tái)和3條運(yùn)動(dòng)支鏈組成，每條運(yùn)動(dòng)支鏈包括主動(dòng)臂和從動(dòng)臂，從動(dòng)臂為由4根桿件組成的平行四邊形構(gòu)型，其中R表示轉(zhuǎn)動(dòng)副，Pa表示平行四邊形構(gòu)型，該并聯(lián)機(jī)構(gòu)的各個(gè)構(gòu)件之間均通過(guò)轉(zhuǎn)動(dòng)副連接。

圖1 3-RRPaR空間并聯(lián)機(jī)構(gòu)的三維模型Fig.1 Three dimensional model of 3-RRPaR spatial parallel mechanism1.主動(dòng)臂 2.轉(zhuǎn)動(dòng)副 3.從動(dòng)臂 4.定平臺(tái) 5.動(dòng)平臺(tái)

3-RRPaR為閉環(huán)空間并聯(lián)機(jī)構(gòu)，采用修正的Grubler-Kutzbach公式計(jì)算其自由度[22]，計(jì)算公式為

(1)

式中P——機(jī)構(gòu)整體自由度

p——機(jī)構(gòu)構(gòu)件總數(shù)

q——機(jī)構(gòu)運(yùn)動(dòng)副總數(shù)

fk——第k個(gè)運(yùn)動(dòng)副的自由度

h——冗余約束數(shù)

并聯(lián)機(jī)構(gòu)的3條運(yùn)動(dòng)支鏈分布在2個(gè)平面內(nèi)，增加了機(jī)構(gòu)的剛度和平穩(wěn)性，通過(guò)對(duì)3個(gè)主動(dòng)臂的旋轉(zhuǎn)驅(qū)動(dòng)可實(shí)現(xiàn)動(dòng)平臺(tái)的三維移動(dòng)。對(duì)于運(yùn)動(dòng)支鏈中的平行四邊形構(gòu)型，由于引入了冗余約束，在動(dòng)力學(xué)建模過(guò)程中需去掉多余的約束方程。

2 運(yùn)動(dòng)學(xué)模型

機(jī)構(gòu)運(yùn)動(dòng)學(xué)是研究物體的位置、速度和加速度與時(shí)間的關(guān)系，是機(jī)構(gòu)動(dòng)力學(xué)研究的基礎(chǔ)。本文利用閉環(huán)矢量法建立并聯(lián)機(jī)構(gòu)運(yùn)動(dòng)學(xué)模型[23-25]，分別求出機(jī)構(gòu)位置、速度和加速度的逆解。

2.1 位置模型

為方便表示并聯(lián)機(jī)構(gòu)構(gòu)件間的幾何關(guān)系，對(duì)該機(jī)構(gòu)作機(jī)構(gòu)簡(jiǎn)圖如圖2所示。在定平臺(tái)下建立全局坐標(biāo)系Oxyz，動(dòng)平臺(tái)視為質(zhì)點(diǎn)O′，則O′點(diǎn)的位置矢量g=(x,y,z)T可表示為

gi=Mi+l1iui+l2isi-Ni(i=1,2,3)

(2)

式中Mi——鉸點(diǎn)Mi在Oxyz中的位置矢量

Ni——鉸點(diǎn)Ni在O′x′y′z′中的位置矢量

l1i——機(jī)構(gòu)主動(dòng)臂桿長(zhǎng)

l2i——機(jī)構(gòu)從動(dòng)臂桿長(zhǎng)

ui——主動(dòng)臂單位方向矢量

si——從動(dòng)臂單位方向矢量

圖2 3-RRPaR空間并聯(lián)機(jī)構(gòu)簡(jiǎn)圖Fig.2 3-RRPaR spatial parallel mechanism diagram

Mi在定系Oxyz下的位置矢量為

Ni在局部坐標(biāo)系O′x′y′z′下的位置矢量為

為方便計(jì)算，引入單位矢量wi，wi垂直于主動(dòng)臂的旋轉(zhuǎn)面，使得wi×ui能夠表示主動(dòng)臂的旋轉(zhuǎn)方向。ui和wi的表達(dá)式為

將式(2)化簡(jiǎn)，得gi-Mi-l1iui+Ni=l2isi，等式兩邊左乘各自的轉(zhuǎn)置，可得

(3)

將式(3)轉(zhuǎn)換為三角函數(shù)式

Aisinθi+Bicosθi+Ci=0

其中A1=-2l11x

B1=2l11(y+a-m)

A2=2l12(z-b+n)

B2=2l12y

A3=-2l13x

B3=-2l13(y-a+m)

解得主動(dòng)臂的角位移為

(4)

因此，可得從動(dòng)臂單位方向矢量si為

si=(g-Mi-l1iui+Ni)/l2i

(5)

2.2 速度模型

將式(2)兩端關(guān)于時(shí)間求導(dǎo)，得到動(dòng)平臺(tái)質(zhì)心點(diǎn)O′的速度表達(dá)式為

(6)

ωi——從動(dòng)臂角速度矢量

(7)

對(duì)式(6)兩端同時(shí)左叉乘ωi，可求得機(jī)構(gòu)從動(dòng)臂角速度為

(8)

則機(jī)構(gòu)從動(dòng)臂質(zhì)心速度為

(9)

2.3 加速度模型

將式(6)兩端關(guān)于時(shí)間求導(dǎo)，得到動(dòng)平臺(tái)質(zhì)心點(diǎn)O′的加速度表達(dá)式為

(10)

(11)

(12)

則機(jī)構(gòu)從動(dòng)臂質(zhì)心加速度為

(13)

通過(guò)對(duì)并聯(lián)機(jī)構(gòu)進(jìn)行運(yùn)動(dòng)學(xué)逆解，得到主動(dòng)臂角位移、角速度和角加速度。

3 動(dòng)力學(xué)模型

3.1 約束方程

根據(jù)空間并聯(lián)機(jī)構(gòu)各構(gòu)件之間的幾何關(guān)系建立其約束方程。質(zhì)心坐標(biāo)和歐拉角轉(zhuǎn)換矩陣可以準(zhǔn)確描述構(gòu)件的位置和姿態(tài)，易于通過(guò)驅(qū)動(dòng)臂的角度變化來(lái)實(shí)現(xiàn)機(jī)構(gòu)驅(qū)動(dòng)，但對(duì)于特殊情況下的旋轉(zhuǎn)變換，歐拉角存在奇異問(wèn)題。自然坐標(biāo)是利用全局坐標(biāo)系下的絕對(duì)坐標(biāo)來(lái)描述構(gòu)件的運(yùn)動(dòng)狀態(tài)，兩點(diǎn)零矢的自然坐標(biāo)不涉及到構(gòu)件的方向矢量，適用于描述空間構(gòu)件的相對(duì)一維轉(zhuǎn)動(dòng)，但兩點(diǎn)零矢的自然坐標(biāo)不能通過(guò)角度變化來(lái)實(shí)現(xiàn)機(jī)構(gòu)驅(qū)動(dòng)。

3-RRPaR空間并聯(lián)機(jī)構(gòu)為結(jié)構(gòu)冗余的并聯(lián)機(jī)構(gòu)，各個(gè)構(gòu)件之間均通過(guò)轉(zhuǎn)動(dòng)副連接。為了易于驅(qū)動(dòng)，方便地構(gòu)建約束方程并去掉多余的約束，本文對(duì)3個(gè)支鏈的主動(dòng)臂采用質(zhì)心坐標(biāo)和歐拉角來(lái)表示機(jī)構(gòu)構(gòu)件的位置和姿態(tài)，對(duì)其他構(gòu)件采用自然坐標(biāo)來(lái)表示機(jī)構(gòu)構(gòu)件的位置和姿態(tài)。建立自然坐標(biāo)時(shí)，對(duì)于桿構(gòu)件，在桿的兩端建立自然坐標(biāo)，對(duì)于三角板構(gòu)件，在三角板的3個(gè)端點(diǎn)處建立自然坐標(biāo)。則機(jī)構(gòu)整體的廣義坐標(biāo)表示為

q=(O1,O2, …,O30)

其中Ok=(xk,yk,zk)T(k=2,3,…,9,11,12,…, 18,20,21,…,30)，Ok=(xk,yk,zk,αk,βk,γk)T(k=1,10,19)。

該并聯(lián)機(jī)構(gòu)共有99個(gè)廣義坐標(biāo)，且機(jī)構(gòu)有三維移動(dòng)自由度，因此需要添加96個(gè)線性無(wú)關(guān)的約束方程。由于機(jī)構(gòu)復(fù)雜且廣義坐標(biāo)數(shù)目較多，本文以1號(hào)支鏈為例構(gòu)建其約束方程，1號(hào)支鏈構(gòu)件坐標(biāo)表示如圖3所示。

圖3 并聯(lián)機(jī)構(gòu)1號(hào)支鏈坐標(biāo)示意圖Fig.3 Coordinate diagram of No.1 branch chain of parallel mechanism

用質(zhì)心坐標(biāo)和歐拉角表示構(gòu)件位姿時(shí)，可以利用運(yùn)動(dòng)副的約束關(guān)系建立約束方程。空間轉(zhuǎn)動(dòng)副只有一維轉(zhuǎn)動(dòng)，限制了構(gòu)件的三維移動(dòng)和二維轉(zhuǎn)動(dòng)，因此需構(gòu)建5個(gè)約束方程。為了約束兩構(gòu)件之間的相對(duì)移動(dòng)，需使兩構(gòu)件在旋轉(zhuǎn)軸中心上的兩點(diǎn)重合。為了約束兩構(gòu)件之間兩個(gè)方向的相對(duì)轉(zhuǎn)動(dòng)，需沿旋轉(zhuǎn)軸在兩構(gòu)件上分別建立兩個(gè)單位方向向量，使得這兩個(gè)方向向量共線，由于已知1號(hào)支鏈主動(dòng)臂繞z軸旋轉(zhuǎn)，因此可直接限制構(gòu)件另外2個(gè)方向的相對(duì)旋轉(zhuǎn)。可得轉(zhuǎn)動(dòng)副約束方程為

(14)

其中

式中Ru1——1號(hào)支鏈主動(dòng)臂繞z軸的旋轉(zhuǎn)矩陣

O3×1、O2×1——零矩陣

l11——1號(hào)支鏈主動(dòng)臂桿長(zhǎng)

利用自然坐標(biāo)表示構(gòu)件位姿時(shí)，可直接根據(jù)構(gòu)件的幾何關(guān)系建立約束方程

(15)

(16)

Φ4=O4-O2=O3×1

(17)

Φ5=O6-O3=O3×1

(18)

Φ6=|O5-O4|-l21=0

(19)

Φ7=O8-O5=O3×1

(20)

Φ8=O9-O7=O3×1

(21)

(22)

(23)

式中l(wèi)21——1號(hào)支鏈從動(dòng)臂桿長(zhǎng)

lx——平行四邊形構(gòu)型中小桿桿長(zhǎng)

根據(jù)動(dòng)平臺(tái)的尺寸和運(yùn)動(dòng)狀態(tài)建立約束方程

(24)

(25)

由運(yùn)動(dòng)學(xué)模型可知主動(dòng)臂角位移變化函數(shù)，則對(duì)機(jī)構(gòu)動(dòng)力學(xué)模型建立驅(qū)動(dòng)約束方程為

(26)

式中Φd——機(jī)構(gòu)主動(dòng)臂驅(qū)動(dòng)約束方程

由式(26)組成3-RRPaR空間并聯(lián)機(jī)構(gòu)理想約束方程

Φ(q)=[Φ1Φ2…Φ32Φd]T=O99×1

(27)

式中Φ1～Φ10——1號(hào)支鏈約束方程

Φ11～Φ20——2號(hào)支鏈約束方程

Φ21～Φ30——3號(hào)支鏈約束方程

3.2 質(zhì)量矩陣

質(zhì)量矩陣是質(zhì)量到廣義坐標(biāo)的推廣，是機(jī)構(gòu)動(dòng)力學(xué)方程的重要組成部分，而質(zhì)心坐標(biāo)和自然坐標(biāo)可以方便地表示構(gòu)件的質(zhì)量矩陣。

對(duì)于質(zhì)心坐標(biāo)下構(gòu)件對(duì)應(yīng)的質(zhì)量矩陣，由構(gòu)件局部坐標(biāo)原點(diǎn)的移動(dòng)分量對(duì)應(yīng)的質(zhì)量矩陣和構(gòu)件局部坐標(biāo)原點(diǎn)的轉(zhuǎn)動(dòng)分量對(duì)應(yīng)的慣性張量矩陣組成，可分別表示為

Nj=diag(mj,mj,mj) (j=1,6,11)

(28)

Jj=diag(Ixj,Iyj,Izj) (j=1,6,11)

(29)

則質(zhì)心坐標(biāo)下構(gòu)件j對(duì)應(yīng)的質(zhì)量矩陣為

Mj=diag(Nj,Jj) (j=1,6,11)

(30)

對(duì)于自然坐標(biāo)下構(gòu)件對(duì)應(yīng)的質(zhì)量矩陣，可利用慣性力的虛功率分別求出桿單元和三角板單元的質(zhì)量矩陣，桿單元和三角板單元(動(dòng)平臺(tái))的質(zhì)量矩陣分別為

(31)

(32)

式中I3——三階單位矩陣

則系統(tǒng)整體質(zhì)量矩陣為

M=diag(M1,M2,…,M16)

(33)

3.3 動(dòng)力學(xué)方程

利用拉格朗日乘子法來(lái)建立并聯(lián)機(jī)構(gòu)剛體動(dòng)力學(xué)方程。將式(27)對(duì)時(shí)間求一階導(dǎo)數(shù)，得到系統(tǒng)速度約束方程為

(34)

式中Φq——系統(tǒng)約束方程的Jacobian矩陣

將式(27)對(duì)時(shí)間求二階導(dǎo)數(shù)，得到系統(tǒng)加速度約束方程為

(35)

利用拉格朗日法建立3-RRPaR空間并聯(lián)機(jī)構(gòu)帶有拉格朗日乘子的動(dòng)力學(xué)方程為

(36)

式中δ、η——大于0的修正參數(shù)[25]

λ——系統(tǒng)拉格朗日乘子矢量

Q——系統(tǒng)廣義外力矢量

求解該動(dòng)力學(xué)方程可得到系統(tǒng)的廣義坐標(biāo)對(duì)應(yīng)的廣義加速度和拉格朗日乘子矢量。通過(guò)系統(tǒng)的廣義加速度，積分得到系統(tǒng)的廣義速度和廣義坐標(biāo)，可用來(lái)描述間隙對(duì)系統(tǒng)動(dòng)力學(xué)的影響，為研究含間隙動(dòng)力學(xué)打下基礎(chǔ)。通過(guò)拉格朗日乘子矢量，可求得主動(dòng)臂轉(zhuǎn)動(dòng)副處的驅(qū)動(dòng)力矩，完成3-RRPaR空間并聯(lián)機(jī)構(gòu)動(dòng)力學(xué)逆解。則i號(hào)支鏈驅(qū)動(dòng)桿轉(zhuǎn)動(dòng)副處驅(qū)動(dòng)力矩為

(37)

Ri——i號(hào)支鏈主動(dòng)臂局部坐標(biāo)系關(guān)于全局坐標(biāo)系的轉(zhuǎn)換矩陣

ρi——i號(hào)支鏈主動(dòng)臂轉(zhuǎn)動(dòng)鉸點(diǎn)在其局部坐標(biāo)系中的位置矢量

4 算例仿真與分析

4.1 仿真參數(shù)

根據(jù)上述理論模型利用Matlab編寫(xiě)程序，進(jìn)行3-RRPaR空間并聯(lián)機(jī)構(gòu)動(dòng)力學(xué)方程的數(shù)值求解。利用Matlab自帶的ode45算法進(jìn)行數(shù)值求解，使得計(jì)算效率更高，結(jié)果更精確。

3-RRPaR空間并聯(lián)機(jī)構(gòu)的構(gòu)件轉(zhuǎn)動(dòng)慣量和構(gòu)件參數(shù)如表1～3所示。

表1 3-RRPaR空間并聯(lián)機(jī)構(gòu)主動(dòng)臂轉(zhuǎn)動(dòng)慣量Tab.1 Moment of inertia of active arm of 3-RRPaR spatial parallel mechanism kg·m2

圖4 動(dòng)平臺(tái)動(dòng)態(tài)響應(yīng)曲線Fig.4 Dynamic response curves of moving platform

表2 3-RRPaR空間并聯(lián)機(jī)構(gòu)的結(jié)構(gòu)參數(shù)Tab.2 Structural parameters of 3-RRPaR spatial parallel mechanism

表3 定平臺(tái)和動(dòng)平臺(tái)尺寸參數(shù)Tab.3 Size parameters of fixed platform and moving platform m

4.2 仿真結(jié)果與分析

為了分析并聯(lián)機(jī)構(gòu)的動(dòng)力學(xué)響應(yīng)，需要對(duì)動(dòng)平臺(tái)規(guī)劃一條運(yùn)動(dòng)軌跡。已知并聯(lián)機(jī)構(gòu)有三維移動(dòng)自由度，使得動(dòng)平臺(tái)中心點(diǎn)在全局坐標(biāo)系Y-Z平面運(yùn)動(dòng)軌跡為圓軌跡，其運(yùn)動(dòng)方程描述為

(38)

動(dòng)平臺(tái)在全局坐標(biāo)系下的起始點(diǎn)為(0.54, 0.15, 0.08)，利用Matlab對(duì)動(dòng)力學(xué)方程進(jìn)行數(shù)值求解，得到該機(jī)構(gòu)動(dòng)平臺(tái)位移、速度和加速度曲線，然后利用拉格朗日乘子和約束力矩的關(guān)系求解出驅(qū)動(dòng)桿處的驅(qū)動(dòng)力矩，并將結(jié)果與ADAMS仿真結(jié)果進(jìn)行對(duì)比，對(duì)機(jī)構(gòu)動(dòng)態(tài)響應(yīng)曲線進(jìn)行分析。

圖4是該機(jī)構(gòu)動(dòng)平臺(tái)動(dòng)態(tài)響應(yīng)曲線，分別求出了機(jī)構(gòu)剛體時(shí)動(dòng)平臺(tái)的位移、速度和加速度，與規(guī)劃的運(yùn)動(dòng)軌跡相同，驗(yàn)證了該動(dòng)力學(xué)模型的正確性，為分析含間隙時(shí)的動(dòng)力學(xué)模型打好基礎(chǔ)。

圖5 并聯(lián)機(jī)構(gòu)驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩曲線Fig.5 Driving torque curves of driving rod

圖5a為該并聯(lián)機(jī)構(gòu)空載時(shí)驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩曲線。從圖5a可以看出，Matlab求解動(dòng)力學(xué)模型所得驅(qū)動(dòng)力矩曲線和ADAMS虛擬仿真所得驅(qū)動(dòng)力矩曲線基本吻合，但有較小誤差。其中3號(hào)驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩誤差最大，為0.027 N·m；1號(hào)驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩誤差次之，為0.015 3 N·m；2號(hào)驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩誤差最小，為0.002 3 N·m?？蛰d時(shí)，3號(hào)支鏈驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩最大，最大值達(dá)到4 N·m，1號(hào)支鏈和2號(hào)支鏈驅(qū)動(dòng)力矩較小且相差不大，為0.8 N·m左右。

圖5b為該并聯(lián)機(jī)構(gòu)動(dòng)平臺(tái)加載1 kg時(shí)驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩曲線。從圖5b可以看出，動(dòng)平臺(tái)加載1 kg之后，驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩?cái)?shù)值相應(yīng)增大，Matlab與ADAMS數(shù)值結(jié)果的誤差也隨之增大，但幅值和周期基本沒(méi)有變化。3號(hào)驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩最大為6 N·m ，誤差為0.027 N·m ；1號(hào)驅(qū)動(dòng)桿和2號(hào)驅(qū)動(dòng)桿驅(qū)動(dòng)力矩相差不大，為1 N·m，誤差也相應(yīng)較小，1號(hào)驅(qū)動(dòng)桿誤差為 0.014 N·m，2號(hào)驅(qū)動(dòng)桿誤差為0.004 N·m。

由以上分析可知，通過(guò)剛體動(dòng)力學(xué)模型求解出的并聯(lián)機(jī)構(gòu)動(dòng)平臺(tái)的位移、速度和加速度，結(jié)果與所規(guī)劃軌跡完全吻合，分別對(duì)比了機(jī)構(gòu)空載和加載時(shí)驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩，Matlab與ADAMS結(jié)果基本一致，驗(yàn)證了3-RRPaR空間并聯(lián)機(jī)構(gòu)剛體動(dòng)力學(xué)模型的正確性。

5 結(jié)論

(1)分析了3-RRPaR并聯(lián)機(jī)構(gòu)的結(jié)構(gòu)特征，利用閉環(huán)矢量法建立了該機(jī)構(gòu)的逆運(yùn)動(dòng)學(xué)模型，得到了主動(dòng)臂的角位移、角速度和角加速度。

(2)通過(guò)質(zhì)心坐標(biāo)法和自然坐標(biāo)法建立了并聯(lián)機(jī)構(gòu)的約束方程，分別計(jì)算出質(zhì)心坐標(biāo)和自然坐標(biāo)下構(gòu)件的質(zhì)量矩陣，利用拉格朗日乘子法建立了3-RRPaR空間并聯(lián)機(jī)構(gòu)的動(dòng)力學(xué)方程，并根據(jù)拉格朗日乘子和驅(qū)動(dòng)力矩的關(guān)系求解出驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩。

(3)通過(guò)Matlab求解3-RRPaR并聯(lián)機(jī)構(gòu)的剛體動(dòng)力學(xué)方程，得到并聯(lián)機(jī)構(gòu)動(dòng)平臺(tái)的位移、速度和加速度，結(jié)果與所規(guī)劃軌跡完全吻合，通過(guò)ADAMS虛擬仿真得到機(jī)構(gòu)空載和加載時(shí)驅(qū)動(dòng)桿的驅(qū)動(dòng)力矩曲線，與Matlab數(shù)值計(jì)算結(jié)果進(jìn)行對(duì)比分析，驗(yàn)證了3-RRPaR空間并聯(lián)機(jī)構(gòu)剛體動(dòng)力學(xué)模型的正確性。