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

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

?

冗余驅動支鏈對3RPS并聯(lián)機構剛度的改善

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

1.中北大學，太原，0300512.北京航空航天大學，北京，100191

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

關鍵詞：冗余驅動；瞬時剛度模型；矢量微分法；并聯(lián)運動機構；位姿偏移

0引言

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

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

13RPS+UPS冗余驅動并聯(lián)機構結構簡介

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

圖1　3RPS+UPS冗余驅動并聯(lián)機構

23RPS并聯(lián)機構剛度模型

2.13RPS并聯(lián)機構力平衡分析

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

F+Jflfl=0

(1)

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

2.2支鏈剛度分析

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

圖2　RPS支鏈結構圖

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

(2)

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

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

(3)

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

(4)

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

2.3支鏈彈性變形與動平臺位姿關系

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

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

(5)

式中，Bi為并聯(lián)機構參考坐標系原點到支鏈轉動副R轉軸中點的矢徑；li為當前位姿時支鏈矢徑；R為動平臺的姿態(tài)矩陣。

當外載荷發(fā)生變化時，設動平臺中心位置由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在外作用力下的彈性變形量，包括軸向和側向變形量；δp為機構變形后動平臺隨動坐標系原點位置的偏移微量；δR為機構變形后動坐標系姿態(tài)的偏移微量。由機器人機構學可知，動平臺姿態(tài)的偏移量δR可等效為隨動坐標系繞過其原點的某一轉軸轉過一個微小角度δθ，其等效微分旋轉變換矩陣滿足關系式δRpbi=δθ×Rpbi。

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

δli=δp+δθ×Rpbi

(7)

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

δl=JvlδD

(8)

Jvl=

2.43RPS并聯(lián)機構瞬時剛度模型

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

(9)

由機構學可知

(10)

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

(11)

由式(8)，并結合式(11)，可得機構整機剛度矩陣：

(12)

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

Kl=JflklJvl

(13)

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

3冗余驅動支鏈對并聯(lián)機構剛度的改善

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

3.1冗余驅動并聯(lián)機構各支鏈運動協(xié)調關系

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

圖3　冗余驅動并聯(lián)機構動平臺受力圖

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

(14)

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

Gff=F

(15)

δl4=l4·δD

(16)

由式(8)和式(16)，可得冗余驅動支鏈與非冗余驅動支鏈之間的變形協(xié)調關系為

(17)

3.2冗余驅動并聯(lián)機構整機剛度模型

由虛功原理可得

(18)

(19)

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

(20)

從而可得

fl4=kl4δl4

(21)

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

(22)

由此可得冗余驅動并聯(lián)機構的外載荷與其動平臺位姿偏移量的映射關系為

(23)

3.3冗余驅動支鏈對并聯(lián)機構剛度的改善

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

表1　3RPS+UPS冗余驅動并聯(lián)機構的參數(shù)

注：表中|li|為由并聯(lián)機構當前位姿決定的支鏈瞬時長度。

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

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

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

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

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

4實驗驗證

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

圖5　不含冗余支鏈時　圖6　含冗余支鏈時　　　機構剛度測量　　 機構剛度測量

5結論

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

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

(3) 對冗余驅動支鏈改善并聯(lián)機構剛度的原理進行了分析，建立了冗余驅動并聯(lián)機構各支鏈的運動協(xié)調關系，仿真計算和實驗證明了冗余驅動支鏈能夠提高并聯(lián)機構的整機剛度。

表2　機構水平剛度測試

表3　機構垂直剛度測試

參考文獻：

[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]白志富，陳五一. 球鉸剛度計算模型及靠冗余支鏈實現(xiàn)并聯(lián)機床剛度的改善[J]. 機械工程學報, 2006, 42(10): 142-145.

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

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

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

[5]周鑫，許允斗，姚建濤,等. 5-UPS/PRPU冗余驅動并聯(lián)機床完整剛度模型及其剛度特性[J]. 光學精密工程，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]竇玉超，姚建濤， 高思慧,等. 冗余驅動并聯(lián)機器人動力學建模與驅動力協(xié)調分配[J]. 農業(yè)機械學報,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

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