衛(wèi)江

（陜西廣播電視大學(xué)工程管理系，陜西西安 710119）

0 引言

少自由度并聯(lián)機器人由于其驅(qū)動元件少、造價低、結(jié)構(gòu)緊湊、誤差小、精度高等優(yōu)點。近年來成為機構(gòu)學(xué)領(lǐng)域中研究的熱點。

程佳［1］研究一種3轉(zhuǎn)動1移動的4-TPS/PS并聯(lián)機構(gòu)的受力特性，推導(dǎo)出該機構(gòu)上平臺與各驅(qū)動支鏈之間的關(guān)系式，得到該機構(gòu)的驅(qū)動支鏈不承受側(cè)向力，側(cè)向力主要由從動支鏈承受;隨后王宣銀［2］利用拉格朗日方程建立了該機構(gòu)的動力學(xué)方程，并通過逆動力學(xué)模型研究了該機構(gòu)的控制策略。LI［3］研究了一種3平移并聯(lián)機構(gòu)的運動學(xué)，給出了3-PRS并聯(lián)機構(gòu)的速度與加速度的性能圖譜。劉劍敏［4］研究了一種用于作物清選的兩轉(zhuǎn)動兩平移的四自由度并聯(lián)機構(gòu)，該機構(gòu)能方便的調(diào)節(jié)振幅和振動方向，并給出了該機構(gòu)的運動學(xué)反解與正解。吳孟麗［5］分析了一種非對稱的并聯(lián)機構(gòu)，并利用雅克比矩陣條件數(shù)為指標(biāo)評價了該機構(gòu)與SKM400機構(gòu)的運動學(xué)性能。王庚祥［6］基于構(gòu)型演變與螺旋理論提出了一種新型的空間3轉(zhuǎn)動1移動的4-SPS/CU并聯(lián)機構(gòu)，并對其進行了運動學(xué)分析。程世利［7］通過分析Stewart平臺的位姿變量之間的耦合關(guān)系，提出了一種研究該機構(gòu)運動學(xué)正解問題的新方法。郭希娟［8-11］通過對并聯(lián)機構(gòu)的運動學(xué)分析評價了多種機構(gòu)的動力學(xué)性能，并且證明了Hessian矩陣對機構(gòu)加速度性能有著重要的作用，該原理同樣適用于串聯(lián)機構(gòu)。

基于此研究背景，本文提出了一種新型的具有2移動和2轉(zhuǎn)動的空間四自由度并聯(lián)機構(gòu)——空間4-SPS/PPU并聯(lián)機構(gòu)。通過對該機構(gòu)的運動學(xué)分析導(dǎo)出了該機構(gòu)的運動學(xué)Jacobian矩陣，并在此基礎(chǔ)上研究了該機構(gòu)的靜力學(xué)，評價了該機構(gòu)的靈巧度與剛度特性。

4-SPS/PPU并聯(lián)機構(gòu)可以直接作為四軸并聯(lián)機床與坐標(biāo)測量機的原型，也可直接用于該環(huán)境下的定位機構(gòu)。

1 4-SPS/PPU并聯(lián)機構(gòu)結(jié)構(gòu)特點

4-SPS/PPU并聯(lián)機構(gòu)模型及其坐標(biāo)系的建立如圖1所示。該機構(gòu)具有4個驅(qū)動支鏈l1，l2，l3，l4（SPS支鏈），以及一個恰約束從動支鏈l5（PPU支鏈）。該4個驅(qū)動支鏈均由兩個球面副（S副）和一個移動副組成。其中各驅(qū)動分支從下平臺算起，與下平臺相連的球面副為第一運動副，移動副為第二運動副，與上平臺相連的球面副為第三運動副;該恰約束從動支鏈由兩個移動副（P副）和一個萬向鉸（U副）組成，其中萬向鉸的中心位于上平臺的質(zhì)心，位于下平臺的移動副與Y軸重合。OXYZ和Pxyz分別是與下平臺和上平臺的固連坐標(biāo)系，O點位于B1B2B3B4組成的邊長為2b的正方形中心，X軸平行于B1B4，Y軸平行于B1B2，Z軸垂直下平臺向上;P點位于A1A2A3A4組成的邊長為2a的正方形中心，x軸平行于A1A4，y軸平行于A1A2，z軸垂直上平臺向上。

圖1 4-SPS/PPU并聯(lián)機構(gòu)簡圖

2 4-SPS/PPU并聯(lián)機構(gòu)自由度計算

采用修正的Kutzbach-Grübler公式計算4-SPS/PPU并聯(lián)機構(gòu)的自由度［12］:

式中:

M——機構(gòu)自由度數(shù);

d——機構(gòu)的階數(shù);

n——包括機架的構(gòu)件數(shù)目;

g——運動副的數(shù)目;

fi——第i個運動副的自由度;

v——并聯(lián)約束因子，是去除了計算在內(nèi)的公共約束的因素后的冗余約束的數(shù)目;

ξ——機構(gòu)中存在的局部自由度。

根據(jù)圖1，4條驅(qū)動支鏈的運動副軸線在坐標(biāo)系OXYZ中可以用螺旋統(tǒng)一表示為

式中:ri、ki——第1運動副相對坐標(biāo)系OXYZ的位置;

ui、vi、wi——第 2 運動副軸線的方向余弦;

li、mi、ni——第 3 運動副相對于坐標(biāo)系OXYZ的位置。

下標(biāo)i=1，2，3，4，為該機構(gòu)的驅(qū)動支鏈序號。

式（2）中的7個運動螺旋，其中6個線性無關(guān);且沒有與該螺旋系相逆的反螺旋。即該螺旋系沒有對上平臺產(chǎn)生任何約束，得出4-SPS/PPU并聯(lián)機構(gòu)沒有公共約束，所以d=6。

恰約束從動支鏈l5運動副軸線在坐標(biāo)系OXYZ中螺旋表示為:

式（3）螺旋系的4個運動螺旋線性無關(guān)，設(shè)與該螺旋系相逆的反螺旋為:

式（4）的約束螺旋系限制了上平臺繞Z軸的轉(zhuǎn)動與沿X軸的移動，且該機構(gòu)無冗余約束，即v=0;觀察整個機構(gòu)運動的布置情況，該并聯(lián)機構(gòu)各驅(qū)動支鏈均存在局部自由度，即ξ=4。

根據(jù)式（1）計算該機構(gòu)自由度:

即上平臺具有沿Y軸和Z軸的移動自由度，繞X軸與Y軸的轉(zhuǎn)動自由度。

3 4-SPS/PPU并聯(lián)機構(gòu)運動分析

3.1 4-SPS/PPU并聯(lián)機構(gòu)的位置分析

Ai點在坐標(biāo)系Pxyz的坐標(biāo)為A1= [a，-a，0]T，A2=[a，a，0]T，A3= [ -a，a，0]T，A4= [ -a，-a，0]T;Bi點在坐標(biāo) 系OXYZ中 的 坐 標(biāo) 為B1= [b，-b，0]T，B2=[b，-b，0]T，B3= [b，-b，0]T，B4= [b，-b，0]T。上平臺相對固定平臺的位姿可以用坐標(biāo)系Pxyz和坐標(biāo)系OXYZ之間的旋轉(zhuǎn)變換矩陣R及兩坐標(biāo)系之間的平移向量n來表示，其中沿X軸的移動與繞Z軸的轉(zhuǎn)動被恰約束從動支鏈限制。即:

其中sβ =sinβ，cβ =cosβ，其余類似。

當(dāng)給定上平臺的位置和姿態(tài)后，各驅(qū)動支鏈的向量可表示為:

根據(jù)式（5）可以求得該機構(gòu)的位置約束方程為:

式中，li為桿長。位置正解是已知結(jié)構(gòu)參數(shù)a、b和4個輸入桿長（l1，l2，l3，l4），求解上平臺的位置（y，z，α，β）。位置反解是已知結(jié)構(gòu)參數(shù)a，b和上平臺的位置（y，z，α，β），求解桿長li（i=1，2，3，4）。

3.2 4-SPS/PPU并聯(lián)機構(gòu)的速度分析

式（8）為該機構(gòu)的運動Jacobian矩陣。

當(dāng)det（J）≠0時，該機構(gòu)的速度正解為:

3.3 4-SPS/PPU并聯(lián)機構(gòu)的加速度分析

當(dāng)J-1為非奇異矩陣，則有:

其中為該并聯(lián)機構(gòu)的Hessian矩陣H，即:

4-SPS/PUU并聯(lián)機構(gòu)的Hessian矩陣為一個4×4×4的三維矩陣，其中該矩陣中的每個元素為:

通過式（10）、（11）可以求得機構(gòu)加速度的逆解和正解。

4 4-SPS/PPU并聯(lián)機構(gòu)的Jacobian矩陣條件數(shù)

Jacobian矩陣條件數(shù)是衡量并聯(lián)機構(gòu)靈巧度的一項重要指標(biāo)，它是一個無量綱數(shù)。根據(jù)3.2節(jié)中式（7）為廣義輸出速度 與上平臺廣義輸出速度 之間的關(guān)系。對式（7）兩邊取偏差:

式（14）與式（7）相減得:

對式（15）與式（9）兩邊取Frobenius范數(shù)以及根據(jù)范數(shù)的相容原理有:

速度的輸入相對偏差與輸出速度之間有下列關(guān)系:

式（18）中‖J‖‖J-1‖為4-SPS/PPU并聯(lián)機構(gòu)的Jacobian矩陣條件數(shù)，它是一個大于或等于1的數(shù)，即:

Jacobian矩陣條件數(shù)g越大，該矩陣的逆矩陣J-1的精度越低，g越小，該機構(gòu)的靈巧度越好，當(dāng)g=1時，機構(gòu)處于最佳的運動傳遞性能，此時機構(gòu)具有各項同性［13］。

5 數(shù)值計算

不妨設(shè)4-SPS/PPU并聯(lián)機構(gòu)上平臺質(zhì)心P的運動軌跡為:

1）當(dāng)該機構(gòu)的上平臺邊長a=1 m，下平臺邊長b=2.5 m時，該機構(gòu)Jacobian矩陣的條件數(shù)隨時間的變化曲線如圖2。

圖2 4-SPS/PPU并聯(lián)機構(gòu)Jacobian矩陣條件數(shù)

2）當(dāng)該機構(gòu)的上平臺邊長a=1.5 m，下平臺邊長b=3 m時，該機構(gòu)Jacobian矩陣的條件數(shù)隨時間的變化曲線如圖3。

由圖2與圖3可知，當(dāng)4-SPS/PPU并聯(lián)機構(gòu)的結(jié)構(gòu)參數(shù)不同時，該機構(gòu)Jacobian矩陣的條件數(shù)有明顯區(qū)別，即結(jié)構(gòu)參數(shù)影響了該機構(gòu)的靈巧度。且該機構(gòu)具有良好的活動性。

圖3 4-SPS/PPU并聯(lián)機構(gòu)Jacobian矩陣條件數(shù)

6 結(jié)論

1）提出了一種新型的兩轉(zhuǎn)動兩平移的4-SPS/PPU并聯(lián)機構(gòu)，采用螺旋理論計算了4-SPS/PPU并聯(lián)機構(gòu)的自由度。討論了該機構(gòu)的位置反解與正解，研究了該機構(gòu)的速度與加速度。導(dǎo)出了Jacobian矩陣與Hessian矩陣。

2）在該機構(gòu)速度分析的基礎(chǔ)上，利用對速度方程兩邊取偏差的方法推導(dǎo)出該機構(gòu)的Jacobian矩陣條件數(shù)，通過數(shù)值分析研究了該機構(gòu)靈巧度在不同結(jié)構(gòu)參數(shù)下隨時間變化的規(guī)律，驗證了結(jié)構(gòu)參數(shù)對該機構(gòu)靈巧度的影響。

［1］程佳，王宣銀，李強.4TPS-PS并聯(lián)四自由度電動平臺的受力特性研究［J］.哈爾濱工業(yè)大學(xué)學(xué)報，2009，41（1）:108-112.

［2］王宣銀，程佳.4TPS-PS四自由度并聯(lián)電動平臺動力學(xué)建模與位置閉環(huán)魯棒控制［J］.浙江大學(xué)學(xué)報，2009，43（8）:1492-1496.

［3］Li Yangmin，Xu Qingsong.Kinematic analysis of a 3-PRS parallel manipulator［J］.Robotics and Computer-Integrated Manufacturing，2007.23（4）:395-408.

［4］劉劍敏，馬履中，許子紅.振動篩兩平移兩轉(zhuǎn)動并聯(lián)機構(gòu)的運動學(xué)分析［J］.農(nóng)業(yè)機械報，2008，39（2）:59-62.

［5］吳孟麗，張大衛(wèi)，趙興玉.一種新型非對稱并聯(lián)機構(gòu)的運動學(xué)分析［J］.中國機械工程，2008，19（12）:1423-1427.

［6］王庚祥，原大寧，劉宏昭，等.空間4—SPS/CU并聯(lián)機構(gòu)運動學(xué)分析［J］.農(nóng)業(yè)機械學(xué)報，2012，43（3）:207-212.

［7］程世利，吳洪濤，王超群.基于正交補的6-3 Stewart并聯(lián)機構(gòu)運動學(xué)正解［J］.中國機械工程，2011，22（5）:505-508.

［8］寧淑榮，郭希娟，黃真.一種新型并聯(lián)機構(gòu)4-RPR的性能分析［J］.機械科學(xué)與技術(shù)，2007，26（2）:184-187.

［9］劉爽，郭希娟，劉彬.4-RR（RR）R并聯(lián)機構(gòu)的動力學(xué)性能指標(biāo)分析［J］.機械工程學(xué)報，2008，44（7）:32-68.

［10］郭希娟，耿清甲.串聯(lián)機器人加速度性能指標(biāo)分析［J］.機械工程學(xué)報，2008，44（9）:56-60.

［11］張世輝，孔令富，郭希娟.6-HURU并聯(lián)機器人機構(gòu)運動學(xué)和動力學(xué)性能指標(biāo)分析［J］.中國機械工程，2004，15（20）:1800-1803.

［12］黃真，趙永生，趙鐵石.高等空間機構(gòu)學(xué)［M］.北京:高等教育出版社，2006.