崔學(xué)良　陳五一　韓先國　祝錫晶　王建青　成　全

1.中北大學(xué)，太原，030051　　2.北京航空航天大學(xué)，北京，100191

?

冗余驅(qū)動支鏈對3RPS并聯(lián)機(jī)構(gòu)剛度的改善

崔學(xué)良1陳五一2韓先國2祝錫晶1王建青1成全1

1.中北大學(xué)，太原，0300512.北京航空航天大學(xué)，北京，100191

摘要：在考慮雅可比矩陣變化與動平臺姿態(tài)偏移之間映射關(guān)系的基礎(chǔ)上，基于螺旋理論和矢量微分法建立了3RPS并聯(lián)機(jī)構(gòu)末端位姿偏移與支鏈構(gòu)件變形之間的映射模型。首先采用螺旋理論和矢量微分法分析了支鏈各構(gòu)件剛度與整個支鏈剛度之間的關(guān)系，然后建立了3RPS并聯(lián)機(jī)構(gòu)的瞬時剛度模型，并分析了雅可比矩陣的變化對機(jī)構(gòu)剛度的影響。對冗余驅(qū)動支鏈改善并聯(lián)機(jī)構(gòu)剛度的原理進(jìn)行了分析，建立了冗余驅(qū)動并聯(lián)機(jī)構(gòu)的整機(jī)剛度模型。仿真分析和實(shí)驗(yàn)驗(yàn)證，冗余驅(qū)動支鏈確實(shí)能夠改善并聯(lián)機(jī)構(gòu)的剛度。

關(guān)鍵詞：冗余驅(qū)動；瞬時剛度模型；矢量微分法；并聯(lián)運(yùn)動機(jī)構(gòu)；位姿偏移

0引言

少自由度并聯(lián)機(jī)構(gòu)結(jié)構(gòu)簡單，控制方便，具有廣闊的工程應(yīng)用前景。但由于各支鏈同時受拉和受彎，因此更易產(chǎn)生變形，這導(dǎo)致并聯(lián)機(jī)構(gòu)整體剛度變?nèi)酰┒司茸儾?。同時，由于并聯(lián)機(jī)構(gòu)耦合嚴(yán)重，故難以設(shè)計(jì)全閉環(huán)控制系統(tǒng)以對其位姿偏差進(jìn)行有效補(bǔ)償。鑒于此，人們提出增加冗余驅(qū)動支鏈來提高并聯(lián)機(jī)構(gòu)剛度的方法。文獻(xiàn)[1-2]對平面并聯(lián)機(jī)構(gòu)進(jìn)行了剛度分析、參數(shù)優(yōu)化和動力學(xué)等方面研究，并采用有限元方法進(jìn)行了相關(guān)分析驗(yàn)證。文獻(xiàn)[3-4]中，研究者針對不同的空間并聯(lián)機(jī)構(gòu)，提出了增加冗余驅(qū)動支鏈以改善并聯(lián)機(jī)構(gòu)剛度的策略，并進(jìn)行了相應(yīng)的分析和驗(yàn)證。文獻(xiàn)[5-6]分別基于虛功原理和能量守恒定理研究了冗余驅(qū)動并聯(lián)機(jī)構(gòu)的完整剛度模型和所有支鏈的彈性變形協(xié)調(diào)方程。文獻(xiàn)[7]通過對含驅(qū)動和被動冗余支鏈的三自由度并聯(lián)機(jī)構(gòu)進(jìn)行對比分析，得出了冗余驅(qū)動支鏈能夠提高并聯(lián)機(jī)構(gòu)剛度的結(jié)論。文獻(xiàn)[8-9]對冗余驅(qū)動并聯(lián)機(jī)構(gòu)進(jìn)行了驅(qū)動支鏈和整機(jī)剛度分析，并對冗余驅(qū)動支鏈的協(xié)調(diào)驅(qū)動力進(jìn)行了優(yōu)化設(shè)計(jì)。

3RPS并聯(lián)機(jī)床作為一種實(shí)用化程度較高的并聯(lián)機(jī)構(gòu)，已應(yīng)用于航空、汽車等制造裝配領(lǐng)域，但其剛度、精度等指標(biāo)并不比傳統(tǒng)機(jī)床高。本課題組研制了3RPS+UPS冗余驅(qū)動并聯(lián)機(jī)床，通過合理布置冗余驅(qū)動支鏈可在消除部分奇異、增大姿態(tài)能力的同時改善整機(jī)的剛度。本文分析研究冗余驅(qū)動支鏈對并聯(lián)機(jī)構(gòu)剛度改善作用的機(jī)理。通過與非冗余驅(qū)動并聯(lián)機(jī)構(gòu)剛度模型比較分析可知，增加冗余驅(qū)動支鏈確實(shí)可提高并聯(lián)機(jī)構(gòu)的剛度。

13RPS+UPS冗余驅(qū)動并聯(lián)機(jī)構(gòu)結(jié)構(gòu)簡介

3RPS+UPS并聯(lián)機(jī)構(gòu)結(jié)構(gòu)及坐標(biāo)系如圖1所示。其中，oxyz為參考坐標(biāo)系，puvw為隨動坐標(biāo)系。UPS支鏈為冗余驅(qū)動支鏈，其中的胡克鉸U連接支鏈與靜平臺，U副中點(diǎn)B4位于靜平臺幾何中心；移動副P為冗余支鏈l4的驅(qū)動副，球鉸S連接冗余支鏈與動平臺，球心b4位于動平臺中心p。

圖1　3RPS+UPS冗余驅(qū)動并聯(lián)機(jī)構(gòu)

23RPS并聯(lián)機(jī)構(gòu)剛度模型

2.13RPS并聯(lián)機(jī)構(gòu)力平衡分析

力平衡分析是并聯(lián)機(jī)構(gòu)剛度模型建立的基礎(chǔ)。3RPS并聯(lián)機(jī)構(gòu)的受力平衡方程為

F+Jflfl=0

(1)

式中，F(xiàn)為動平臺所受外載荷；Jfl為3-RPS并聯(lián)機(jī)構(gòu)的力雅可比矩陣，由各支鏈的軸向和切向作用力單位線矢組成；fl為各支鏈對動平臺作用力大小所構(gòu)成的矢量。

2.2支鏈剛度分析

支鏈采用伺服電機(jī)加滾珠絲杠螺母副作為驅(qū)動機(jī)構(gòu)；為提高支鏈運(yùn)動的直線度，采用直線導(dǎo)軌作為移動導(dǎo)向機(jī)構(gòu)。滾珠絲杠螺母系統(tǒng)包括絲杠、螺母、滑塊、直線導(dǎo)軌和軸承，絲杠與直線導(dǎo)軌固接在同一基座上，絲杠兩端由軸承分別與基座連接，支鏈結(jié)構(gòu)如圖2所示。絲杠、直線導(dǎo)軌和基座的軸向和側(cè)向剛度是影響支鏈剛度的主要因素。

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

由圖2可見，支鏈中的絲杠和軸承組成一個串聯(lián)系統(tǒng)，分別記其軸向和側(cè)向剛度為kda和kdt，則有

(2)

式中，ksa、kst分別為該串聯(lián)系統(tǒng)中絲杠的軸向和側(cè)向剛度；kca、kct分別為軸承的軸向和徑向剛度。

絲杠和直線導(dǎo)軌組成一個并聯(lián)系統(tǒng)，分別記其軸向和側(cè)向剛度為kpa和kpt。圖2中，直線導(dǎo)軌固接在基座上，記導(dǎo)軌與基座結(jié)合體的軸向和側(cè)向剛度分別為kga和kgt，則有

(3)

支鏈末端由一個伸出軸與球鉸相連，該伸出軸由軸承和絲杠導(dǎo)軌系統(tǒng)連接，從而組成整個支鏈。記支鏈總的軸向和側(cè)向剛度分別為kla和klt，則有

(4)

式中，kza、kzt分別為支鏈前端伸出軸的軸向和側(cè)向剛度。

2.3支鏈彈性變形與動平臺位姿關(guān)系

設(shè)3RPS并聯(lián)機(jī)構(gòu)變形前動平臺中心在參考坐標(biāo)系中為p，鉸鏈球心在動平臺隨動坐標(biāo)系中的位置為pbi。則由位置反解模型可知，3RPS并聯(lián)機(jī)構(gòu)在變形前滿足幾何約束方程:

Bi+li=p+Rpbii=1, 2, 3

(5)

式中，Bi為并聯(lián)機(jī)構(gòu)參考坐標(biāo)系原點(diǎn)到支鏈轉(zhuǎn)動副R轉(zhuǎn)軸中點(diǎn)的矢徑；li為當(dāng)前位姿時支鏈?zhǔn)笍?；R為動平臺的姿態(tài)矩陣。

當(dāng)外載荷發(fā)生變化時，設(shè)動平臺中心位置由p變?yōu)閜′(p′=p+δp)；其姿態(tài)矩陣由R變?yōu)镽′(R′=R+δR)，則有

Bi+li+δli=p+δp+(R+δR)pbi

(6)

其中，δli為支鏈li在外作用力下的彈性變形量，包括軸向和側(cè)向變形量；δp為機(jī)構(gòu)變形后動平臺隨動坐標(biāo)系原點(diǎn)位置的偏移微量；δR為機(jī)構(gòu)變形后動坐標(biāo)系姿態(tài)的偏移微量。由機(jī)器人機(jī)構(gòu)學(xué)可知，動平臺姿態(tài)的偏移量δR可等效為隨動坐標(biāo)系繞過其原點(diǎn)的某一轉(zhuǎn)軸轉(zhuǎn)過一個微小角度δθ，其等效微分旋轉(zhuǎn)變換矩陣滿足關(guān)系式δRpbi=δθ×Rpbi。

由式(5)和式(6)可得

δli=δp+δθ×Rpbi

(7)

式(7)兩端分別點(diǎn)乘lai和lti(i=1, 2, 3)并整理，可得并聯(lián)機(jī)構(gòu)動平臺位姿偏移與支鏈li彈性變形之間的幾何約束方程:

δl=JvlδD

(8)

Jvl=

2.43RPS并聯(lián)機(jī)構(gòu)瞬時剛度模型

對式(1)進(jìn)行全微分，并考慮到支鏈li(i=1, 2, 3)在外載荷下的彈性變形關(guān)系式δfl=-klδl，當(dāng)δJfl≠0時，可得

(9)

由機(jī)構(gòu)學(xué)可知

(10)

其中，符號“?”表示矩陣的張量積；K為并聯(lián)機(jī)構(gòu)的整體剛度矩陣。當(dāng)矩陣Jfl非奇異時，由式(10)可得支鏈li彈性變形與動平臺位姿偏移量之間的關(guān)系式：

(11)

由式(8)，并結(jié)合式(11)，可得機(jī)構(gòu)整機(jī)剛度矩陣：

(12)

忽略雅可比矩陣變化量對機(jī)構(gòu)整體連續(xù)剛度的影響，即令δJfl=0，且將此時機(jī)構(gòu)整機(jī)剛度記為Kl，則式(12)可進(jìn)一步簡化為

Kl=JflklJvl

(13)

式(13)即為典型的并聯(lián)機(jī)構(gòu)簡化剛度模型。

3冗余驅(qū)動支鏈對并聯(lián)機(jī)構(gòu)剛度的改善

由上面分析可知，少自由度并聯(lián)機(jī)構(gòu)支鏈需同時對動平臺提供約束力和驅(qū)動力，已不再是單純的二力桿，在載荷作用下容易產(chǎn)生變形，從而影響機(jī)構(gòu)的整體剛度。為此，人們提出增加冗余驅(qū)動支鏈的方法來改善并聯(lián)機(jī)構(gòu)的整機(jī)剛度。本節(jié)以3RPS+UPS冗余驅(qū)動并聯(lián)機(jī)構(gòu)為例，對冗余驅(qū)動支鏈能提高并聯(lián)機(jī)構(gòu)剛度的原理進(jìn)行分析和研究。

3.1冗余驅(qū)動并聯(lián)機(jī)構(gòu)各支鏈運(yùn)動協(xié)調(diào)關(guān)系

3RPS+UPS并聯(lián)機(jī)構(gòu)結(jié)構(gòu)如圖1所示。取動平臺為研究對象，其作用力平衡關(guān)系如圖3所示。

圖3　冗余驅(qū)動并聯(lián)機(jī)構(gòu)動平臺受力圖

由矢量投影法，建立3RPS+UPS冗余驅(qū)動并聯(lián)機(jī)構(gòu)動平臺上的力平衡方程如下：

(14)

將式(14)寫成矩陣形式，有

Gff=F

(15)

δl4=l4·δD

(16)

由式(8)和式(16)，可得冗余驅(qū)動支鏈與非冗余驅(qū)動支鏈之間的變形協(xié)調(diào)關(guān)系為

(17)

3.2冗余驅(qū)動并聯(lián)機(jī)構(gòu)整機(jī)剛度模型

由虛功原理可得

(18)

(19)

冗余驅(qū)動UPS支鏈的驅(qū)動系統(tǒng)包括絲杠、螺母和軸承，令支鏈中絲杠、螺母和軸承的軸向剛度分別為ks、kn和kb，且記其軸向剛度為kl4，則有

(20)

從而可得

fl4=kl4δl4

(21)

由式(18)~式(21)，并結(jié)合式(15)~式(17)可得

(22)

由此可得冗余驅(qū)動并聯(lián)機(jī)構(gòu)的外載荷與其動平臺位姿偏移量的映射關(guān)系為

(23)

3.3冗余驅(qū)動支鏈對并聯(lián)機(jī)構(gòu)剛度的改善

為評價(jià)冗余驅(qū)動對并聯(lián)機(jī)構(gòu)剛度指標(biāo)的影響，分別計(jì)算冗余驅(qū)動并聯(lián)機(jī)構(gòu)和非冗余驅(qū)動并聯(lián)機(jī)構(gòu)剛度模型在相同外載荷下末端位姿偏移量的大小。支鏈的剛度與其長度有關(guān)，設(shè)冗余驅(qū)動并聯(lián)機(jī)構(gòu)的冗余驅(qū)動支鏈l4的軸線剛度為4.824×109/|l4|N/mm，其余參數(shù)同非冗余驅(qū)動并聯(lián)機(jī)構(gòu)(表1)。結(jié)果如圖4所示。

表1　3RPS+UPS冗余驅(qū)動并聯(lián)機(jī)構(gòu)的參數(shù)

注：表中|li|為由并聯(lián)機(jī)構(gòu)當(dāng)前位姿決定的支鏈瞬時長度。

由圖4可看出，在相同外載荷作用下，冗余驅(qū)動并聯(lián)機(jī)構(gòu)末端位姿偏移量小于非冗余驅(qū)動并聯(lián)機(jī)構(gòu)的位姿偏移量，表明采用冗余驅(qū)動的確能夠提高并聯(lián)機(jī)構(gòu)的剛度。

(a)章動角為45°，z向距離為0.8 m

(b)章動角為45°，z向距離為1.2 m

(c)進(jìn)動角為180°，z向距離為0.8 m

(d)進(jìn)動角為180°，z向距離為1.2 m圖4　不同位姿處冗余驅(qū)動與非冗余驅(qū)動并聯(lián)機(jī)構(gòu)剛度的比較

4實(shí)驗(yàn)驗(yàn)證

以本課題組研制的3PRS+UPS冗余驅(qū)動并聯(lián)機(jī)構(gòu)為例，分別測量不加冗余驅(qū)動支鏈和增加冗余驅(qū)動支鏈時機(jī)構(gòu)的末端剛度。通過比較二者的差別，考察冗余驅(qū)動支鏈對并聯(lián)機(jī)構(gòu)剛度的影響。實(shí)驗(yàn)采用砝碼+千分表的方案，圖5和圖6是測量水平和垂直剛度的實(shí)驗(yàn)照片。其中，剛度測量中的外力是用外掛砝碼實(shí)現(xiàn)的，通過專用夾具將外力作用在動平臺中心；動平臺上粘結(jié)了一個圓球，以便在不同姿態(tài)時，用千分表都能測量到動平臺沿水平或垂直方向的位移。測量結(jié)果如表2、表3所示。

圖5　不含冗余支鏈時　圖6　含冗余支鏈時　　　機(jī)構(gòu)剛度測量　　 機(jī)構(gòu)剛度測量

5結(jié)論

(1) 采用螺旋理論和矢量微分法分析了3RPS并聯(lián)機(jī)構(gòu)支鏈及復(fù)合鉸鏈在外載荷及自重力作用下的彈性變形，建立了機(jī)構(gòu)末端位姿偏移與支鏈構(gòu)件變形的映射關(guān)系。

(2) 考慮支鏈彈性變形影響，建立了并聯(lián)機(jī)構(gòu)瞬時剛度模型。分析了雅可比矩陣的變化對機(jī)構(gòu)的剛度影響，當(dāng)動平臺處于其姿態(tài)空間邊界處時，其影響尤為明顯。

(3) 對冗余驅(qū)動支鏈改善并聯(lián)機(jī)構(gòu)剛度的原理進(jìn)行了分析，建立了冗余驅(qū)動并聯(lián)機(jī)構(gòu)各支鏈的運(yùn)動協(xié)調(diào)關(guān)系，仿真計(jì)算和實(shí)驗(yàn)證明了冗余驅(qū)動支鏈能夠提高并聯(lián)機(jī)構(gòu)的整機(jī)剛度。

表2　機(jī)構(gòu)水平剛度測試

表3　機(jī)構(gòu)垂直剛度測試

參考文獻(xiàn)：

[1]WuJun,WangJinsong,WangLiping.DynamicsandControlofaPlanar3-DOFParallelManipulatorwithActuationRedundancy[J].MechanismandMachineTheory, 2009, 44: 835-849.

[2]WangSongtao,ChengGang,PangYusong,etal.IntegratedStiffnessAnalysisofRedundantParallelManipulatorBasedonFiniteElementMethod[J].JournalofInformation&ComputationalScience, 2015, 12(1): 351-365.

[3]白志富，陳五一. 球鉸剛度計(jì)算模型及靠冗余支鏈實(shí)現(xiàn)并聯(lián)機(jī)床剛度的改善[J]. 機(jī)械工程學(xué)報(bào), 2006, 42(10): 142-145.

BaiZhifu,ChenWuyi.StiffnessComputationModelofSphericalJointsandPKM’sStiffnessImprovementbyRedundantLeg[J].ChineseJournalofMechanicalEngineering, 2006, 42(10): 142-145.

[4]宋軼民，翟學(xué)東，孫濤,等. 一種三自由度冗余驅(qū)動并聯(lián)模塊的剛度分析[J]. 天津大學(xué)學(xué)報(bào)(自然科學(xué)與工程技術(shù)版), 2015, 48(1): 25-32.

SongYimin,ZhaiXuedong,SunTao,etal.StiffnessAnalysisofa3-DOFRedundantlyActuatedParallelModule[J].JournalofTianjinUniversity(ScienceandTechnology), 2015, 48(1): 25-32.

[5]周鑫，許允斗，姚建濤,等. 5-UPS/PRPU冗余驅(qū)動并聯(lián)機(jī)床完整剛度模型及其剛度特性[J]. 光學(xué)精密工程，2015，23(4):1070-1080.

ZhouXin,XuYundou,YaoJiantao,etal.CompleteStiffnessModelandStiffnessPerformanceof5-UPS/PRPURedundantlyActuatedParallelMachineTool[J].OpticsandPrecisionEngineering, 2015，23(4):1070-1080.

[6]XuYundou,YaoJiantao,ZhaoYongsheng.InverseDynamicsandInternalForcesoftheRedundantlyActuatedParallelManipulators[J].MechanismandMachineTheory, 2012, 51: 172-184.

[8]JinSangrok,KimJongwon,SeoTaeWon.OptimizationofaRedundantlyActuated5RSymmetricalParallelMechanismBasedonStructuralStiffness[J].Robotica, 2015, 7: 1-11.

[9]竇玉超，姚建濤， 高思慧,等. 冗余驅(qū)動并聯(lián)機(jī)器人動力學(xué)建模與驅(qū)動力協(xié)調(diào)分配[J]. 農(nóng)業(yè)機(jī)械學(xué)報(bào),2014， 45(1)：293-299.

DouYuchao,YaoJiantao,GaoSihui,etal.DynaimicModelingandDrivingForceCoordinateDistributionoftheParallelRobotwithRedundantActuation[J].TransactionsoftheChineseSocietyforAgriculturalMachinery, 2014，45(1)：293-299.

(編輯袁興玲)

Stiffness Improvement of 3RPS PKM by Redundant Actuating Leg

Cui Xueliang1Chen Wuyi2Han Xianguo2Zhu Xijing1Wang Jianqing1Cheng Quan2

1.North University of China，Taiyuan,030051

2. Beihang University,Beijing,100191

Abstract:Considering the relationship between the changes of the Jacobian matrix and the orientation deviation of the moving platform, the mapping model between the 3RPS PKM end-effector offset and the deformation of the branches was established by using the vector differential method, based on the screw theory. The functional expression of the rigidity of the chain and its components was derived, and then the instant stiffness model of the 3RPS PKM was built up. The influences of the changes of the Jacobian matrix on the stiffness of the PKM were analyzed. The theories that the redundant actuating leg could increase the stiffness of the PKM were discussed, and were also verified by the simulation and the tests.

Key words:redundant actuation; instant stiffness model; vector differential method; parallel kinematic machanism(PKM);position and orientation offset

收稿日期：2015-07-30

中圖分類號：TH112DOI：10.3969/j.issn.1004-132X.2015.23.008

作者簡介：崔學(xué)良，男，1971年生。中北大學(xué)機(jī)械與工程學(xué)院講師。研究方向?yàn)榫芘c特種加工技術(shù)。發(fā)表論文4篇。陳五一，男，1951年生。北京航空航天大學(xué)機(jī)械工程及自動化學(xué)院教授。韓先國，男，1970年生。北京航空航天大學(xué)機(jī)械工程及自動化學(xué)院副教授。祝錫晶，男，1969年生。中北大學(xué)機(jī)械與工程學(xué)院教授。王建青，女，1973年生。中北大學(xué)機(jī)械與工程學(xué)院副教授。成全，男，1969年生。中北大學(xué)機(jī)械與工程學(xué)院講師。