盛連超, 李 威, 王禹橋, 范孟豹, 楊雪鋒

(中國(guó)礦業(yè)大學(xué) 機(jī)電工程學(xué)院，江蘇 徐州 221116)

相對(duì)于串聯(lián)機(jī)器人，并聯(lián)機(jī)器人具有高速度、高加速度、高承載能力、低能耗、無(wú)累積誤差、精度高等優(yōu)點(diǎn)，被廣泛用于航空航天、精密光學(xué)儀器、生物工程操作、精密加工機(jī)床等領(lǐng)域[1-5]。

隨著社會(huì)的發(fā)展，高速高效、輕型低耗成為當(dāng)今全球機(jī)械產(chǎn)品的重要標(biāo)志和發(fā)展趨勢(shì)[6-8]，但輕型化的柔性并聯(lián)機(jī)器人在高速帶載情況下運(yùn)行時(shí)，由于慣性力等諸多因素，各柔性桿件極易產(chǎn)生彈性變形，導(dǎo)致機(jī)器人的整體動(dòng)態(tài)性能下降，影響其正常工作[9-11]。如應(yīng)用在食品包裝中的拾取類(lèi)并聯(lián)機(jī)器人[12]及農(nóng)業(yè)采摘機(jī)器人[13-14]。

為了解決這個(gè)問(wèn)題，首先要建立柔性并聯(lián)機(jī)器人動(dòng)力學(xué)模型[15]，徐晗[16]、余躍慶[17]、張清華[18]、張緒沖[19]分別采用不用方法，考慮不同因素建立了平面3-RRR平面并聯(lián)機(jī)器人的動(dòng)力學(xué)模型。 Sharifnia[20]，Zhang等[21-22]采用假設(shè)模態(tài)法分別對(duì)柔性3-PSP和平面3-RRR并聯(lián)機(jī)器人建立了動(dòng)力學(xué)模型。

然而通過(guò)目前的研究發(fā)現(xiàn)，簡(jiǎn)單的動(dòng)力學(xué)模型極易產(chǎn)生過(guò)大的誤差，而精確度較高的模型往往特別復(fù)雜，導(dǎo)致后續(xù)振動(dòng)控制難度較大甚至無(wú)法實(shí)施。因此選取合適的動(dòng)力學(xué)建模方法，考慮實(shí)際邊界條件及影響因素，建立既能保證高精確度，同時(shí)又能方便求解的動(dòng)力學(xué)模型具有重要的研究意義。針對(duì)上述存在的問(wèn)題，本文考慮系統(tǒng)剛?cè)狁詈闲?yīng)及柔性中間連桿兩端集中轉(zhuǎn)動(dòng)慣量影響，選取動(dòng)態(tài)參數(shù)相對(duì)較少，基于系統(tǒng)模態(tài)特性為建?；A(chǔ)的假設(shè)模態(tài)法為建模方法，通過(guò)拉格朗日方程建立平面3-RRR并聯(lián)機(jī)器人耦合動(dòng)力學(xué)模型，并與有限元軟件(ANSYS)分析及模態(tài)試驗(yàn)結(jié)果作比較，結(jié)果表明文中所建立動(dòng)力學(xué)模型能夠有效反映系統(tǒng)主要振動(dòng)模態(tài)，并能充分反映慣性力和耦合力對(duì)系統(tǒng)模態(tài)特性的影響，這對(duì)后續(xù)的振動(dòng)控制及結(jié)構(gòu)優(yōu)化設(shè)計(jì)提供了有力的參考依據(jù)。

1 柔性3-RRR平面并聯(lián)機(jī)器人系統(tǒng)概況

柔性平面3-RRR并聯(lián)機(jī)器人的系統(tǒng)構(gòu)成及坐標(biāo)系如圖1所示，系統(tǒng)由末端運(yùn)動(dòng)平臺(tái)C1C2C3,固定支撐平臺(tái)A1A2A3,三條連接末端運(yùn)動(dòng)平臺(tái)和固定支撐平臺(tái)的支鏈A1B1C1，A2B2C2，A3B3C3組成，且三條支鏈完全相同，即A1B1=A2B2=A3B3,B1C1=B2C2=B3C3,通過(guò)轉(zhuǎn)動(dòng)副將驅(qū)動(dòng)連桿與柔性中間連桿以及柔性中間連桿與動(dòng)平臺(tái)進(jìn)行連接，其中A1、A2、A3是驅(qū)動(dòng)關(guān)節(jié)，桿長(zhǎng)A1B1=A2B2=A3B3=B1C1=B2C2=B3C3=210 mm,末端運(yùn)動(dòng)平臺(tái)上關(guān)節(jié)所在圓的半徑為R=68 mm。在三個(gè)驅(qū)動(dòng)電機(jī)的驅(qū)動(dòng)下，該并聯(lián)平臺(tái)可以完成沿x軸方向和y軸方向的平動(dòng)運(yùn)動(dòng)以及繞z軸方向的轉(zhuǎn)動(dòng)運(yùn)動(dòng)的三自由度運(yùn)動(dòng)。

圖1 柔性平面3-RRR并聯(lián)機(jī)器人平面示意圖Fig.1 The structure diagram of the flexible planar 3-RRR parallel robot

在實(shí)際結(jié)構(gòu)中，一般情況下驅(qū)動(dòng)連桿橫截面積尺寸較大以保證其剛度，而柔性中間連桿截面積尺寸較小以減輕其質(zhì)量。柔性平面3-RRR并聯(lián)機(jī)器人的具體材料、尺寸參數(shù)如下，加工材料為鋁合金7075，材料的彈性模量為E=7.1×1010N/m2，密度為ρ=2.81×103kg/m3，主動(dòng)桿的長(zhǎng)寬厚分別為210 mm，25 mm，10 mm，柔性中間連桿的長(zhǎng)寬厚分別為210 mm，25 mm，5 mm，柔性中間連桿兩端的集中轉(zhuǎn)動(dòng)慣量JBi=JCi=2.2×10-3kg/m2，截面慣性矩Ii=2.6×10-10m4。

機(jī)構(gòu)的振動(dòng)主要是由電機(jī)驅(qū)動(dòng)、慣性力和移動(dòng)平臺(tái)的有效載荷造成的。為了進(jìn)一步確定系統(tǒng)的振動(dòng)情況，減小不必要的計(jì)算，提高計(jì)算速度，應(yīng)對(duì)柔性并聯(lián)機(jī)器人的模型作簡(jiǎn)化?？紤]到柔性并聯(lián)機(jī)器人的運(yùn)動(dòng)部件只有各運(yùn)動(dòng)支鏈和動(dòng)平臺(tái)，電機(jī)、減速器及其支架等都固連在底座上，實(shí)際中為保證運(yùn)行平穩(wěn)，剛度支撐等要求，底座設(shè)計(jì)得比較厚重，這里可以將除運(yùn)動(dòng)支鏈和動(dòng)平臺(tái)之外的部件視為固定，運(yùn)動(dòng)支鏈的主動(dòng)桿的電機(jī)驅(qū)動(dòng)端視為與基座固定，同時(shí)，對(duì)各支鏈和動(dòng)平臺(tái)上的倒角、圓角、非必要的孔等特征也進(jìn)行簡(jiǎn)化，簡(jiǎn)化后的柔性平面3-RRR并聯(lián)機(jī)器人有限元(ANSYS)仿真結(jié)果如圖2所示，前四階振動(dòng)頻率分別為66.894 Hz、68.289 Hz、85.716 Hz、122.57 Hz，通過(guò)前四階振型發(fā)現(xiàn)，發(fā)生彎曲的部位主要集中在柔性中間連桿部分，第四階振型顯示，柔性中間連桿不僅發(fā)生彎曲甚至發(fā)生扭轉(zhuǎn)，這將直接導(dǎo)致末端運(yùn)動(dòng)平臺(tái)的傾覆，影響末端運(yùn)動(dòng)平臺(tái)的操作精度和質(zhì)量，因此如何控制中間連桿的振動(dòng)以及找出其共振頻率就顯得非常重要，這也為提高末端運(yùn)動(dòng)平臺(tái)操作精度和質(zhì)量打下堅(jiān)實(shí)的基礎(chǔ)。

圖2 柔性平面3-RRR并聯(lián)機(jī)器人的前四階振型Fig.2 The first four mode shapes of flexible planar 3-RRR parallel robot

2 動(dòng)力學(xué)建模與數(shù)值仿真

2.1 有限元分析法

在有限元分析軟件(ANSYS)中建立柔性中間連桿的物理模型，材料選擇鋁合金，柔性中間連桿兩端邊界條件設(shè)置為鉸支，并定義為柔性接觸，同時(shí)考慮兩端集中質(zhì)量和轉(zhuǎn)動(dòng)慣量的影響。仿真分析結(jié)果如圖3所示, 柔性中間連桿前兩階振動(dòng)頻率分別為53.18 Hz，204.07 Hz。

圖3 柔性中間連桿前兩階模態(tài)振型Fig.3 The first two mode shapes of flexible intermediate link

2.2 假設(shè)模態(tài)法

基于有限元(ANSYS)分析的結(jié)果,如圖2所示，驅(qū)動(dòng)連桿的振動(dòng)幅值要遠(yuǎn)小于中間連桿的振動(dòng)幅值，因此在建模過(guò)程中只把中間連桿作為柔性桿處理，而其他構(gòu)件均視為剛性構(gòu)件。機(jī)器人系統(tǒng)坐標(biāo)如圖1所示，其中給出了柔性中間連桿的變形和不變形兩種狀態(tài)。在建模過(guò)程中，做如下假設(shè)：①基于Euler-Bernoulli梁模型分析柔性中間連桿系統(tǒng)動(dòng)力學(xué)特性，只考慮柔性中間連桿在運(yùn)動(dòng)方向的橫向振動(dòng)；②相對(duì)于柔性中間連桿的長(zhǎng)度，其橫向變形是小變形，所以方程可被線(xiàn)性化處理；③忽略重力的影響。為了與上述有限元(ANSYS)分析作對(duì)比，建模過(guò)程中柔性中間連桿尺寸、材料等因素均與上述有限元(ANSYS)分析法中的條件一致。考慮柔性中間連桿兩個(gè)末端軸承引入集中轉(zhuǎn)動(dòng)慣量的影響，基于假設(shè)模態(tài)法，建立系統(tǒng)耦合動(dòng)力學(xué)模型。

第i根柔性中間連桿的變形可以表達(dá)為：

(1)

式中：φij(x)為模型的振型函數(shù)；qij(t)為時(shí)間變化的模態(tài)幅度；r代表所選的假設(shè)模態(tài)。

每個(gè)柔性中間連桿都被看作是Euler-Bernoulli梁，末端運(yùn)動(dòng)平臺(tái)和驅(qū)動(dòng)連桿均被看作剛體，柔性中間連桿的邊界條件采用兩端鉸支的約束方式，所以，振型函數(shù)φij(x)可以表示為：

φij(x)=sin(jπx/L)=sin(jπξ)=φij(ξ),j=1, 2, …,r

(2)

式中：ξ=x/L，r代表所選的假設(shè)模態(tài)，驅(qū)動(dòng)連桿和柔性中間連桿的桿長(zhǎng)均為L(zhǎng)，x是柔性中間連桿上任意一點(diǎn)到Bi點(diǎn)的距離。

為了獲得柔性中間連桿的動(dòng)力學(xué)方程，與Lagrange方程聯(lián)合建模，因此需要先求得系統(tǒng)的動(dòng)能和勢(shì)能。系統(tǒng)的總動(dòng)能包括驅(qū)動(dòng)連桿、柔性中間連桿和末端運(yùn)動(dòng)平臺(tái)的動(dòng)能，見(jiàn)式(3)。

(3)

當(dāng)柔性平面機(jī)器人運(yùn)動(dòng)時(shí)，重力沿著z軸方向并穿過(guò)一個(gè)x-y平面，所以機(jī)器人重力造成的勢(shì)能并不發(fā)生改變。系統(tǒng)的勢(shì)能是由柔性中間連桿的變形造成的，可表示為：

(4)

式中：Ei和Ii分別代表第i根柔性中間連桿的彈性模量和截面慣性矩。

將系統(tǒng)動(dòng)能和勢(shì)能代入拉格朗日第二類(lèi)方程

(5)

整理后為：

(6)

將其寫(xiě)成矩陣形式：

(7)

因此第i根柔性桿件的第j階響應(yīng)可以表示為，

(8)

(9)

根據(jù)Duhamel積分求解上述方程，則其響應(yīng)為

(10)

假定柔性并聯(lián)機(jī)器人末端執(zhí)行器的運(yùn)行軌跡為半徑60 mm的圓，xp=60-60cos 20πtmm，yp=60sin(20πt) mm。由于三根柔性中間連桿的參數(shù)一致，本文以柔性中間連桿1為例，研究其動(dòng)態(tài)特性，柔性中間連桿1中點(diǎn)前兩階響應(yīng)的運(yùn)動(dòng)仿真結(jié)果，圖4所示。

圖4 柔性中間連桿1中點(diǎn)處的前兩階響應(yīng)Fig.4 The first two elastic vibration deformation at midpoint of the first intermediate link

通過(guò)圖4中得到的柔性中間連桿1中點(diǎn)處前兩階曲線(xiàn)可以看出柔性中間連桿的一階振動(dòng)響應(yīng)幅值明顯高于二階振動(dòng)響應(yīng)幅值，柔性中間連桿的振動(dòng)響應(yīng)是機(jī)器人在工作運(yùn)行過(guò)程中產(chǎn)生振動(dòng)的一個(gè)表征，為了進(jìn)一步研究其振動(dòng)特性，確定振動(dòng)產(chǎn)生的頻率，降低對(duì)機(jī)器人整體性能的影響，通過(guò)快速傅里葉變換將柔性中間連桿1中點(diǎn)處的一階響應(yīng)特性從時(shí)域轉(zhuǎn)化到頻域中，如圖5所示。

圖5 柔性中間連桿1中點(diǎn)處的第一階振動(dòng)響應(yīng)FFT變換Fig.5 FFT of the first order elastic vibration of the first intermediate link

圖6 柔性中間連桿所受慣性力和耦合力Fig.6 The inertial force and coupling force of the first intermediate link

從圖5中可以看出其振動(dòng)頻率主要集中在10 Hz，20 Hz，30 Hz和48.5 Hz附近，根據(jù)公式(6)，可以算出柔性中間連桿在考慮轉(zhuǎn)動(dòng)慣量的情況下的前兩階自由振動(dòng)頻率分別為48.5 Hz，212.6 Hz,通過(guò)公式(6)還可以發(fā)現(xiàn)，除了自由振動(dòng)，柔性中間連桿還受到慣性力和耦合力的作用產(chǎn)生強(qiáng)迫振動(dòng)，慣性力和耦合力隨時(shí)間的變化曲線(xiàn)，如圖6所示。

為了進(jìn)一步研究其振動(dòng)頻率，將慣性力和耦合力動(dòng)態(tài)響應(yīng)曲線(xiàn)進(jìn)行快速傅里葉變換，得到頻域特性，如圖7所示。

從圖7中得到的結(jié)果發(fā)現(xiàn)，10 Hz，20 Hz，30 Hz為慣性力和耦合力共同引起的強(qiáng)迫振動(dòng)頻率，這也意味著48.5 Hz和212.6 Hz為其一階和二階自由振動(dòng)頻率。

3 實(shí)驗(yàn)驗(yàn)證與對(duì)比分析

為了比較兩種動(dòng)力學(xué)分析方法的準(zhǔn)確性和實(shí)用性，搭建如圖8所示的實(shí)驗(yàn)臺(tái)，在實(shí)驗(yàn)過(guò)程中，將三個(gè)驅(qū)動(dòng)電機(jī)鎖緊在初始位置，末端運(yùn)動(dòng)平臺(tái)在中心位置 ，柔性中間連桿均勻布置7個(gè)測(cè)點(diǎn)，其中測(cè)點(diǎn)1和7在軸承處不作測(cè)量，采用多點(diǎn)激勵(lì)一點(diǎn)拾振的測(cè)試方法，將加速度傳感器粘貼在固定測(cè)點(diǎn)3處，用力錘分別敲擊測(cè)點(diǎn)2到測(cè)點(diǎn)6，所測(cè)數(shù)據(jù)通過(guò)與DH5927N動(dòng)態(tài)測(cè)試儀連接的加速度傳感器和力錘采集，為了使結(jié)果更具真實(shí)性，每個(gè)測(cè)點(diǎn)測(cè)試5次，取平均值作為試驗(yàn)結(jié)果，采集數(shù)據(jù)由DH5927N動(dòng)態(tài)測(cè)試儀記錄，采集記錄完成后，采用Polylscf分析法分析其動(dòng)態(tài)響應(yīng)，測(cè)點(diǎn)2到測(cè)點(diǎn)6的頻響特性曲線(xiàn)結(jié)果如圖9所示。分析結(jié)果發(fā)現(xiàn)一階頻率和阻尼比分別為49.992 Hz和0.043，二階振動(dòng)頻率和阻尼比分別為277.813 Hz和 0.022。根據(jù)所得試驗(yàn)結(jié)果表明，基于文中所建動(dòng)力學(xué)模型得到的前兩階振動(dòng)頻率分別為48.5 Hz，212.6 Hz，與有限元(ANSYS)得到的前兩階振動(dòng)頻率53.18 Hz, 204.07 Hz相比，文中所建動(dòng)力學(xué)模型得到的前兩階固有頻率更接近模態(tài)試驗(yàn)結(jié)果，特別是一階固有頻率基本一致，因此文中考慮剛?cè)狁詈弦蛩丶叭嵝灾虚g連桿兩端集中轉(zhuǎn)動(dòng)慣量所建立的動(dòng)力學(xué)模型能較好的反映出柔性平面3-RRR并聯(lián)機(jī)器人柔性中間連桿的主要振動(dòng)模態(tài)，也證明了此方法更準(zhǔn)確，同時(shí)也證明了10 Hz，20 Hz，30 Hz的振動(dòng)頻率不是系統(tǒng)本身?yè)碛械念l率，而是在運(yùn)動(dòng)過(guò)程中慣性力和耦合力產(chǎn)生影響引起的強(qiáng)迫振動(dòng)頻率，二階固有頻率產(chǎn)生較大誤差的主要原因主要是兩種方法在建模過(guò)程中的簡(jiǎn)化處理，弱化了結(jié)構(gòu)體對(duì)柔性中間連桿固有頻率的影響，對(duì)比兩種動(dòng)力學(xué)分析方法，文中通過(guò)數(shù)學(xué)方法所建立動(dòng)力學(xué)模型在分析帶有柔性中間連桿剛?cè)狁詈舷到y(tǒng)的固有頻率及剛?cè)狁詈闲?yīng)時(shí)有更高的精度，同時(shí)由于動(dòng)態(tài)參數(shù)較少，方便依托動(dòng)力學(xué)模型的控制器設(shè)計(jì)。

圖9 振動(dòng)響應(yīng)模態(tài)試驗(yàn)結(jié)果Fig.9 The vibration response results of modal experiment

4 結(jié) 論

(1)相對(duì)于有限元分析軟件(ANSYS)，本文基于假設(shè)模態(tài)法所建立的耦合動(dòng)力學(xué)模型能夠反映集中轉(zhuǎn)動(dòng)慣量及剛?cè)狁詈闲?yīng)對(duì)系統(tǒng)動(dòng)態(tài)特性的影響，與實(shí)際更符。

(2)考慮中間連桿端部集中轉(zhuǎn)動(dòng)慣量和剛?cè)狁詈闲?yīng)的影響，文中建立的耦合動(dòng)力學(xué)模型可以分析耦合力和慣性力對(duì)柔性中間連桿模態(tài)特性的影響，研究結(jié)果發(fā)現(xiàn)，慣性力和耦合力會(huì)導(dǎo)致強(qiáng)迫振動(dòng)，其頻率為10 Hz，20 Hz，30 Hz。

(3)文中所提出的剛?cè)狁詈蟿?dòng)力學(xué)建模方法適用于各種剛?cè)峤Y(jié)合的柔性并聯(lián)機(jī)器人，所得模型精度高、易求解，解決了動(dòng)力學(xué)模型復(fù)雜性問(wèn)題，對(duì)需要以動(dòng)力學(xué)模型為依托的控制器具有指導(dǎo)意義。