王 程, 項濟南, 李秦川, 陳巧紅
(浙江理工大學, a. 機械與自動控制學院; b. 信息學院, 杭州 310018)
3-PRRU并聯(lián)機構靜力分析
王 程a, 項濟南a, 李秦川a, 陳巧紅b
(浙江理工大學, a. 機械與自動控制學院; b. 信息學院, 杭州 310018)
3-PRRU并聯(lián)機構具有兩個轉動自由度和一個移動自由度,無伴隨運動,具有廣泛的用途,目前相關研究主要集中于運動學層面,靜力分析相關研究相對較少。采用矢量法對3-PRRU并聯(lián)機構進行靜力分析,首先通過拆桿法建立了機構在一般位姿下的各桿件的力/力偶平衡方程,然后求解出機構在整個工作空間中的運動副約束反力和主動力,最后通過數(shù)值實例計算驗證。研究結果可為3-PRRU并聯(lián)機構的結構設計和實際應用提供理論基礎。
并聯(lián)機構; 靜力分析; 約束力/力偶
并聯(lián)機構具有剛度高、承載能力大、慣性小、精度高等特點[1],已被用作航空航天、醫(yī)療、工業(yè)、軍事等各個領域。自由度數(shù)少于6的少自由度并聯(lián)機構稱為少自由度并聯(lián)機構,該類機構由于結構簡單、制造和控制成本低等優(yōu)點成為本領域研究的熱點[1-2]。
[PP]S類并聯(lián)機構是少自由度并聯(lián)機構中的重要一類,具有一個移動自由度(T)和兩個轉動自由度(R),包括3-PRS、3-RPS、3-RRS和3-PPS等機構,具有很大工程應用潛力。[PP]S類并聯(lián)機構已被用作望遠鏡聚焦裝置[3]、運動模擬器[4]、微操作機械手[5]、坐標測量機[6]、加工中心的主軸頭[7]等。3-PRRU并聯(lián)機構屬于[PP]S類并聯(lián)機構[8],其中P表示移動副,R表示轉動副,U表示萬向鉸。3-PRRU并聯(lián)機構動平臺的中心被限制在一條直線上運動,因此沒有伴隨運動,其運動控制模型較之3-PRS等并聯(lián)機構更為簡單[9],具有較大的應用潛力。
機構運作并非只是處于運動狀態(tài),很多工程中對機械設備的靜承載能力要求較高,例如天文望遠鏡、機床定點工作等,因此靜力分析作為機構動力分析的基礎非常重要。目前文獻中所涉及的機構靜力分析方法有螺旋理論法、矢量法、影響系數(shù)法等。艾青林等[10]對并聯(lián)機構剛度和靜力分析的國內外進展進行了總結;趙燕等[11-12]通過傳統(tǒng)力學的方法分別分析了含有過約束和不含過約束的兩類經(jīng)典并聯(lián)機構;李永剛等[13]通過虛功原理的方法建立了少自由度并聯(lián)機構的驅動力和約束力的完整靜力映射,并通過此方法分析了3-UPU并聯(lián)機構;周玉林等[14-15]運用傳統(tǒng)力學拆桿法求解了3自由度球面并聯(lián)機構3-RRR的整個力學模型以及二自由度球面并聯(lián)機構UP+R的靜力全解;Agrawal[16]通過螺旋理論的方法系統(tǒng)地分析了串聯(lián)機構和并聯(lián)機構的靜力學模型;Jiegao等[17]對空間3-RRR并聯(lián)機構進行了位置分析并建立了靜平衡模型;Russo等[18]通過矢量法對一種六自由度的并聯(lián)機構進行了靜力平衡建模。目前,對3-PRRU機構的研究基本集中于運動學層面,尚無靜力分析相關研究。
本文采用矢量法分析3-PRRU并聯(lián)機構靜力性能。在各類方法中,矢量法建立靜力模型相對簡單,但計算過于繁瑣,但由于該機構中三個分支結構相同,在建立靜力平衡模型時每一個分支都可以套用第一個分支的受力模型,這樣可以解決矢量法計算的繁瑣問題。本文首先通過拆桿法建立了機構在一般位姿下的各桿件的力/力偶平衡方程,然后求解出機構在整個工作空間中的運動副約束反力和主動力,最后通過數(shù)值實例計算進行驗證。
3-PRRU并聯(lián)機構由上下平臺和三個分支相連接組成,運動平臺為下平臺,如圖1(a)所示。三個分支完全相同,由一個移動副P、兩個轉動副R和一個萬向鉸U組成,其中移動副P運動方向垂直于基平臺,兩個轉動副R的轉動軸線互相平行,且都垂直于移動副運動方向,萬向鉸U中的一個轉動軸錢垂直于兩個轉動副且與動平臺重合,另一個轉動軸線垂直于動平臺。分支一和分支二共面。為方便后文描述,分支中與移動副連接的桿件設為u桿,動平臺連接的桿件設為d桿(如圖1)。
圖1 3-PRRU并聯(lián)機構
采用矢量法分析需要各自建立坐標系。如圖1所示,基坐標系坐標原點位于基平臺中心,YB軸與三個萬向鉸中心連線共線,ZB軸垂直于動平臺向上。動平臺坐標系原點位于動平臺中心,Y軸與三個萬向鉸中心連線共線,Z軸垂直與動平臺向上。分支坐標系原點與移動副中心重合,Z軸與移動副運動方向重合向上,X軸平行于轉動副軸線。少自由度并聯(lián)機構自由度計算可利用修正Kutzbach-Grubler[2]公式:
(1)
其中,M為機構自由度;n為構件數(shù)目;g為運動副數(shù)目;fi是第i個運動副的自由度;d為公共約束因子,d=6-λ,λ為機構的公共約束;v為除去公共約束因素后的冗余約束數(shù)。
初始位形下的3-PRRU機構動平臺與基平臺平行,根據(jù)靜力平衡條件分析各個約束力的大小,以便后文對一般位形下的受力進行驗證。
2.1 動平臺靜力模型
首先對動平臺建立靜力模型。假設動平臺所受所有外力和力偶向質心簡化為一個六維合外力矢量Fh。Fh=(fhTh)T=(fhxfhyfhzThxThyThz)T
(2)
動平臺靜力模型如圖2所示。動平臺受到三個萬向鉸所提供的約束,每個萬向鉸提供三個沿坐標軸方向的約束力fku和一個約束力偶Tku(其中k=x,y,z)。需要指出的是,動平臺受力分析均在動坐標系下進行求解。
圖2 動平臺受力模型
根據(jù)力平衡條件,并向質心取矩可得如下平衡方程:
(3)
2.2 分支靜力模型
對整個分支受力分析以便找出移動副與萬向鉸之間的約束關系方程。三個分支在動平臺與基平臺平行時姿態(tài)相同,可用同一模型表示,如圖3(a)。需要指出的是,分支受力分析均在分支坐標系下進行求解。
圖3 分支受力模型
移動副P和轉動副R為分支提供兩個沿x軸和y軸的約束力和沿y軸和z軸的轉矩。萬向鉸對分支提供三個約束力和一個約束力偶。
將所有分支與動平臺連接的連桿d單獨取出進行受力分析。分析參考坐標系如圖建立,坐標原點與轉動副中心重合。各個運動副對d桿提供的約束力和力偶如圖3(b)所示。
分別對各自x軸取距可得公式(4)、(5)
(4)
(5)
根據(jù)上述所得方程,一共12個方程,12個未知數(shù),可以得出如下系數(shù)矩陣形式方程,并解出當動平臺與基平臺平行時U副對分支提供的各個約束的大小。
由于機構工作中會在不同的位姿下完成所需工作任務,所以需要分析整個工作空間位形下的靜力模型。該機構沿z軸移動的自由度不會影響機構約束變化,所以僅分析機構動平臺轉動時約束變化規(guī)律。
用歐拉角來表示動平臺轉角,假設動平臺沿基坐標系XB軸和YB軸的夾角分別為θ和γ,根據(jù)幾何關系可知兩角的極限位置范圍。
(6)
θ的范圍表示當分支一和分支二分別與動平臺共面時,達到機構轉動的正負極限位置。γ角向負極限位置變大時,由于動平臺會回轉,所以只計算到當l3桿與基平臺平行時的位置。
3.1 動平臺靜力模型
(7)
(8)
圖4 動平臺受力模型
根據(jù)圖4中各個力/力偶方向上的幾何關系可得:
3.2 三個分支靜力模型
各個分支在動平臺正轉情況下的靜力模型如圖5所示,分支受力分析均在分支坐標系下進行求解。
圖5 分支受力模型
根據(jù)圖5靜力模型以及靜平衡條件可以得到下面兩組方程:
(9)
(10)
由于動坐標系姿態(tài)相對于分支三坐標系關系到了三個軸的角度,方向向量不能直觀看出,需要運用旋轉矩陣對動坐標系下的萬向鉸約束力和約束力偶進行坐標變換。通過Z-Y-X歐拉角建立旋轉矩陣來表示坐標變換。其中θ、γ分別為兩個姿態(tài)角,且動平臺沿z軸沒有轉動,那么約束方向向量的坐標轉換可以用式(11)表示:
(11)
其中:
(12)
根據(jù)圖5中結構幾何關系可得各個約束在各自坐標系下的方向矢量:
其中:
k=x,y,z。
3.3 轉動副R靜力求解
轉動約束求解同樣需借助拆桿法,取與轉動副相連接桿件進行受力分析并且求解。為直接解出轉動副的力偶,取三個分支與移動副相連的連桿做受力分析如圖6,因為三個分支此部分的受力模型相同,故可以用一個簡圖來表示。
圖6 轉動副求解模型
根據(jù)圖6模型可以得出關于轉動副R2對分支產(chǎn)生的約束力和約束力偶。根據(jù)靜平衡條件可得公式(13)。
根據(jù)式(7)、(8)、(9)、(10)、(13)可以得到一組含有42個方程的方程組,列出系數(shù)矩陣,通過matlab軟件矩陣左除法對方程組進行求解,可以得到各個約束的變化。
4.1 機構條件設置
假設動平臺所受的已知六維合外力矢量為:
Fh=(fhTh)T=(2 2 3 5 5 6)T
(14)
其中力和力偶的單位分別為N和N·m。
機構參數(shù)如表1。
表1 結構參數(shù)
4.2 動平臺初始姿態(tài)下數(shù)據(jù)結果
根據(jù)第二節(jié)得出方程聯(lián)立并代入數(shù)值,最后可得各個U副的約束力和約束力偶的數(shù)值(見表2)。
4.3 動平臺整個空間姿態(tài)下數(shù)據(jù)結果
根據(jù)第三節(jié)得出結論以及平衡方程可得機構整個工作空間下的靜力全解,并繪出各個運動副約束力/力偶隨工作空間歐拉角變化等高線,如圖7-圖9所示。
表2 得出在動平臺與基平臺平行位形下的各個力的值
圖7為U副的對分支約束變化圖,x軸為動平臺沿x轉角變化的時間軸,y軸為動平臺沿y軸轉角變化的時間軸,圖中線上數(shù)值代表該對應位形下的約束反力/力偶大小。分支三萬向鉸約束反力偶不隨位形變化恒為5 N/m。
圖8為移動副對分支約束變化圖,x軸為動平臺沿x轉角變化的時間軸,y軸為動平臺沿y軸轉角變化的時間軸,線上數(shù)值代表該對應位形下的約束反力/力偶大小。
圖7 各個分支萬向鉸約束反力/力偶(N/N·m)
圖8 各個分支移動副約束反力/力偶(N/N·m)
圖9為轉動副約束變化圖,其中x軸為動平臺沿x轉角變化的時間軸,y軸為動平臺沿y軸轉角變化的時間軸,線上數(shù)值代表該對應位形下的約束反力/力偶大小。
圖7—圖9中可以看出在整個空間位形下,約束反力/力偶變化相對平穩(wěn),當動平臺轉動到接近奇異極限位置時,會發(fā)生劇烈突變,所以該機構在實際運行過程中需盡量避免接近奇異位置。
在程序中設置t=0,也就是當動平臺與基平臺平行的時候,可以得出當動平臺與基平臺平行時的一組約束力和約束力偶的數(shù)據(jù)(見表3)。根據(jù)此數(shù)據(jù)與之前單獨分析動平臺與基平臺平行的位形下解出的各個約束力和力偶的數(shù)值對比,驗證其結果正確性。
圖9 各個分支轉動副約束反力/力偶(N/N·m)
U副約束力/NP副約束力/NR副約束力/NU副約束力偶/(N·m)P副約束力偶/(N·m)R副約束力偶/N·m驅動力/N分支一x-68.881668.881668.8816-4.2458--y000--15.84280z18.8704--18.8704--15.498415.498418.8704分支二x-64.451764.451764.4517-0.0792--y000--14.82390z0.3519--0.3519--14.501614.50160.3519分支三x2.0000-2.0000-2.00005.0000--y2.4299-2.4299-2.4299-0.45730z-22.2222-22.2222-0.5000-0.4500-22.2222
通過表3可以看,出當t=0時各個約束力和力偶與4.2節(jié)計算結果一致。
a) 3-PRRU并聯(lián)機構在受到6維合外力下,在整個工作空間下的受力相對較為均勻,但是當達到奇異極限位形時,各個關節(jié)的所施加的約束力和力偶劇增。
b) 在動平臺所受六維合外力Fh的情況下,根據(jù)整個空間位形下的約束變化圖可以看出,分支一與分支二的萬向鉸(U副)所提供的約束反力相比與分支三的萬向鉸(U副)較大,但是分支三萬向鉸(U副)接近奇異狀態(tài)時提供的約束反力的變化相對于其余兩個分支更加劇烈。約束力偶方面,分支一與分支二萬向鉸(U副)提供的約束力偶變化相對劇烈。分支三的萬向鉸(U副)提供的約束力偶只與動平臺所受外力偶沿y軸分量有關。
[1] Merlet J P. Parallel Robots[M]. Paris Springer 2006: 1-11.
[2] 黃 真, 趙永生, 趙鐵石. 高等空間機構學[M]. 北京: 高等教育出版社, 2006: 1-11.
[3] Carretero J A, Podhorodeski R P, Nahon M A, et al. Kinematic analysis and optimization of a new three degree-of-freedom spatial parallel manipulator[J]. Journal of Mechanical Design, 2000, 122(1): 17-24.
[4] Pouliot N A, Nahon M A, Gosselin C M. Motion simulation capabilities of three-degrees-of-freedom flight simulators[J]. Journal of Aircraft, 1998, 35(1): 9-17.
[5] Yu J J, Hu Y D, Bi S S, et al. Kinematics feature analysis of a 3-DOF compliant mechanism for micro manipulation[J]. Chinese Journal of Mechanical Engineering, 2004, 17(1): 127-131.
[6] Liu D J, Che R S, Li Z F, et al. Research on the theory and the virtual prototype of 3-DOF parallel-link coordinating-measuring machine[J]. IEEE Transactions on Instrumentation and Measurement, 2003, 52(1): 119-125.
[7] Wahl J. Articulated tool head: Germany, WO/2000/025976[P]. 2000-05-11.
[8] Chen Q H, Chen Z, Chai X X, et al, Kinematic analysis of a 3-axis parallel manipulator: the P3[J/OL]. Advances in Mechanical Engineering, 2013[2014-06-27]. http: //dx. doi. org/10. 1155/2013/589156.
[9] 劉辛軍, 吳超, 汪勁松, 等. [PP]S 類并聯(lián)機器人機構姿態(tài)描述方法[J]. 機械工程學報, 2008, 44(10): 19-23.
[10] 艾青林, 黃偉峰, 張洪濤, 等. 并聯(lián)機器人剛度與靜力學研究現(xiàn)狀與進展[J]. 力學進展, 2012, 42(5): 583-592.
[11] 趙 燕, 黃 真. 含過約束力偶的少自由度并聯(lián)機構的受力分析[J]. 機械工程學報, 2010, 46(5): 15-21.
[12] 趙 燕, 黃 真. 3-RPS并聯(lián)機構的主動力和約束力分析[J]. 燕山大學學報, 2008, 32(4): 299-303.
[13] 李永剛, 宋軼民, 黃 田, 等. 少自由度并聯(lián)機構的靜力分析[J]. 機械工程學報, 2007, 43(9): 80-83.
[14] 周玉林, 劉 磊, 高 峰. 3自由度球面并聯(lián)機構3-RRR靜力全解[J]. 機械工程學報, 2008, 44(6): 169-176.
[15] 周玉林, 李 波, 楊 龍, 等. 二自由度球面并聯(lián)機構UP+R靜力學分析[J]. 中國機械工程, 2013, 24 (15): 2081-2087.
[16] Agrawal S K. Static of in-parallel manipulator systems[J]. ASME, 1992, 114: 564-568.
[17] Jiegao W, Clement M, Gosselin. Static balancing of spatial three-degree-of-freedom parallel mechanisms [J]. Mechanism and Machine Theory, 1999, 34: 437-452.
[18] Russo A, Sinatra R, Xi F F. Static balancing of parallel robots [J]. Mechanism and Machine Theory, 2005, 40(2): 191-202.
(責任編輯: 康 鋒)
Static Analysis of 3-PRRU Parallel Manipulator
WANGChenga,XIANGJi-nana,LIQin-chuana,CHENQiao-hongb
(a. Faculty of Mechanical Engineering & Automation; b. The School of Information Science and Technology, Zhejiang Sci-Tech University, Hangzhou 310018, China)
The 3-PRRU parallel manipulator has two rotational degrees of freedom and one translational degree of freedom. It has no parasitic motion and can be implemented in various applications. However, the present studies are mainly focusing on its kinematics, while static analysis and study are inadequate. Static analysis of the 3-PRRU parallel manipulator is performed with the vector method. First, an equation of equilibrium of couples of bars of the manipulator at ordinary pose is established with the method of d, Franceismantling bar, then the pair constraint force and active force of the movement of the manipulator in the whole work space are solved, and the solutions are checked via numerical examples. The work provides a theoretical basis for the structure design and practical application of the 3-PRRU parallel manipulator.
parallel manipulator; static analysis; constraint/couples
1673- 3851 (2015) 01- 0087- 08
2014-06-27
國家自然科學基金資助(51275479)
王 程(1989-),男,陜西渭南人,碩士研究生,主要從事機器人技術方面的研究。
陳巧紅,E-mail:chen_lisa@zstu.edu.cn
TP242; TH112; TH113
A