六自由度混聯機構運動學分析

周 輝， 周 睿， 朱景原， 丁澤華， 曹浩峰， 曹 毅

(1.江南大學 機械工程學院， 無錫 江蘇 214122；2.上海交通大學 系統控制與信息處理教育部重點實驗室， 上海 200240；3.江蘇省食品先進制造裝備技術重點實驗室， 無錫 江蘇 214122)

六自由度混聯機構運動學分析

周 輝1， 3， 周 睿1， 3， 朱景原1， 3， 丁澤華1， 3， 曹浩峰1， 3， 曹 毅1， 2， 3

(1.江南大學 機械工程學院， 無錫 江蘇 214122；2.上海交通大學 系統控制與信息處理教育部重點實驗室， 上海 200240；3.江蘇省食品先進制造裝備技術重點實驗室， 無錫 江蘇 214122)

混聯機構結合了并聯機構和串聯機構兩者的優點，有效地擴大了機器人的應用范圍.提出了一種由兩個不同的三自由度并聯機構串接而成的混聯機構，對其進行運動學分析，分別求取上下兩個并聯模塊的運動學正解方程，從而得到整個混聯機構的運動學正解.通過給定機構結構參數和驅動輸入參數，用一組算例求得運動學動平臺位姿，并畫出三維機構位姿狀態圖模型，更加直觀地了解機構的位姿狀態.然后求解其運動學逆解，按照運動學正解結果，給定機構的兩組位姿，求得此時機構的驅動輸入參數及各轉動副的狀態，對比正反解的結果，進而驗證了雙并聯型混聯機構運動學正反解模型的正確性.最后，在運動學分析的基礎上，利用極限坐標搜索法，結合混聯機構的運動學反解，給出機構工作空間求解的算法.給定機構的結構參數，考慮桿長約束、關節轉動副約束及桿件干涉等影響條件下，利用數值搜索法在圓柱坐標系中搜索工作空間的邊界.在Matlab軟件中仿真得到混聯機構在給定不同姿態下的位置工作空間和給定位置下的姿態工作空間.

混聯機構； 運動學； 極限坐標搜索法； 工作空間

混聯機構結合了傳統的串聯機構和并聯機構的優點，具有承載能力強、剛度大、精度高、工作空間大等優點，有效地擴大了機器人的應用領域[1-2].混聯位置分析是機構分析中的基礎問題，并聯機構的位置分析具有反解簡單、正解復雜的特點，而串聯機構正好相反.兩者綜合起來，混聯機構的位置正解和反解都變得極為復雜[3].

目前對于混聯機構整體位置正反解的研究較少.Pisla等[4]研究了一種由PARAMIS機器人和一個新型串聯定位模塊組成的混聯機構，并給出了數值解.Zeng等[5]研究了空間多回路運動支鏈的串并聯型混聯機構，提出了一種分析輸出位移子集和空間多支鏈機構的自由度的方法.文獻[6]提出了一種適用于重載操作的串并聯鍛造機械臂，根據機構的幾何約束求得了封閉形式的運動學正反解.劉海濤等[7]研究了一類由二自由度球面并聯機構和一條通過移動副與之串接的兩轉動一移動串聯運動鏈組成的五自由度可重構混聯機械手的設計和尺度綜合問題.Lu等[8]提出了一種上端由3-RPS并聯機構，下端由3-SPR并聯機構串接起來的混聯機構，分析了機構的位置正反解、速度、加速度、位置工作空間和姿態工作空間.

本文提出的混聯機構由兩個并聯機構模塊串接而成，每個并聯模塊由兩條SPS六自由度的支鏈，由于其具有6個自由度，故只需對另外一條支鏈進行運動學分析即可.然后分析了機構的位置工作空間和姿態工作空間，對該混聯機構的推廣應用提供一定的理論基礎.

1 混聯機構的描述

混聯機構由兩個并聯機構串聯起來，每個并聯機構都有3個自由度.如圖1所示，位于混聯機構下端部分的并聯機構具有兩條SPS支鏈和一條RPR支鏈，其中RPR支鏈3個運動副呈R1⊥P⊥R2.上面的并聯機構具有兩條SPS支鏈和一條RRR支鏈，其中RR支鏈的3個轉動副相互垂直，呈R3⊥R4⊥R5. R2和R3的轉動軸線相互垂直.下面并聯機構模塊的驅動是位于3條分支上的3個移動副，上面并聯機構模塊的驅動是兩個位于分支上的移動副和另一條支鏈上中間的R4轉動副.上下兩個并聯機構的動平臺和靜平臺都是正三角形.

圖1 混聯機構結構圖Fig.1 Structure diagram of the hybrid mechanism

1.1 自由度計算

正確分析計算機構自由度是機構結構分析的基礎，是機構運動學分析的重要內容.機構自由度分析為確定機構驅動數目及進行運動學分析提供了依據.

位于底部的并聯機構2SPS+RPR稱為并聯模塊1，位于上端的并聯機構2SPS+RRR稱為并聯模塊2.整個混聯機構總的構件數目n=15，包括一個靜平臺，一個動平臺，一個中間平臺.運動副有g= 18，包括8個球副S，5個移動副P，5個轉動副R.由于SPS支鏈都可以繞著自身兩端的球副旋轉，所以每條SPS支鏈存在一個局部自由度[9]，因此ζ=4.運用計算空間機構自由度的Grübler-Kutzbach公式得到此混聯機構的自由度[10]為

(1)

式中：fi為第i個運動副的自由度數；ν為并聯冗余約速，這里不存在.

由式(1)可知，此雙并聯型混聯機構具有6個自由度.

1.2 六自由度混聯機構坐標系建立

混聯機構附坐標系的機構簡圖如圖2所示.R2和R5轉動副的軸線分別垂直于支鏈A3B3和B3D3，它們分別與B3B2和D3D2重合.參考坐標系OXYZ以A3為原點置于靜平臺上，OX軸與A3A2共線，坐標原點O與A3點重合.坐標系O1X1Y1Z1的Z1軸附于支鏈A3B3上，坐標原點O1與A3點重合.O2X2Y2Z2附于中間平臺上，O2X2軸與B3B2共線，坐標原點O2與B3點重合.R2和R3的轉動軸線相互垂直.坐標系O3X3Y3Z3和坐標系O4X4Y4Z4分別固定在支鏈B3D3的兩端，Z3軸和Z4軸與B3D3重合，坐標原點O3和O4分別與B3和D3點重合.O5X5Y5Z5位于上部并聯機構的動平臺上，O5X5的軸線即轉動副的R5的軸線沿著D3D2方向，坐標原點O5與D3點重合.

圖2 混聯機構坐標系簡圖Fig.2 Schematic diagram of the hybrid mechanism of coordinate system

由機構的坐標關系可得相應的變換矩陣為

式中：si和ci(i=1， 2， 3， 4， 5)分別表示sinθi和cosθi，θi表示i個轉動副的角度；L3=‖A3B3‖；L6=‖B3D3‖；Ai表示坐標系OiXiYiZi相對于坐標系Oi-1Xi-1Yi-1Zi-1的變化(i=1， 2， 3， 4， 5).混聯機構的變換矩陣可以寫為

A=A1A2A3A4A5

(2)

2 混聯機構位置正解分析

首先，給定驅動支鏈坐標系及驅動支鏈的長度為L1，L2，L3，L4，L5和驅動角度θ4，分別求取兩個并聯機構的運動學正解，然后再求整個混聯機構的運動學正解.末端操作器的位置相對于參考坐標系可以寫為

rp=(AM1AM2)5rp≡A5rp

(3)

式中:AM1=A1A2，AM2=A3A4A5分別為上下兩個并聯機構的齊次變換矩陣.AM1是描述中間動平臺相對于參考坐標系的位置和姿態的齊次變換矩陣，AM2是描述上面并聯機構動平臺相對于坐標系O2X2Y2Z2的位置和姿態的齊次變換矩陣.5rp是動平臺相對于坐標系O5X5Y5Z5的向量.

本文中左上標表示向量相對的坐標系，相對于參考坐標系OXYZ則沒有上標.

2.1 并聯模塊1的位置正解

首先定義靜平臺和動平臺上各端點關于各自坐標原點的向量，得到下面4個向量如式(4)～(7)所示.

OA1=(a1x，a1y， 0， 1)T

(4)

OA2=(a， 0， 0， 1)T

(5)

2O2B1=(b1x，b1y， 0， 1)T

(6)

2O2B2=(b， 0， 0， 1)T

(7)

位置向量OBi(i=1， 2)相對于參考坐標系可以寫為

OBi=AM12O2Bi，i=1， 2

(8)

支鏈長度L1和L2(L1=A1B1，L2=A2B2)可以寫為

Li=‖OBi-OAi‖，i=1， 2

(9)

式中： ‖·‖表示歐式范數.將其展開得到支鏈一和支鏈二的表達式為

(10)

(11)

化簡式(10)和(11)可以得到下列帶有未知角θ1和θ2的方程：

p1s1+p2c1=q1

(12)

f1s1+f2c1+f3s2+f4c2+f5s1s2+f6=0

(13)

式中：p1、p2、q1、f1、f2、f3、f4、f5、f6、L3的表達式為

由式(12)可以得到θ1的表達式.化簡式(12)并用三角函數萬能公式進行代換，得到θ1的解為

(14)

得到θ1解之后，整理式(13)就可以寫為

p3s2+p4c2=q2

(15)

式中：p3=f3+f5s1；p4=f4；q2=-f1s1-f2c1-f6.

這樣，式(15)就和式(12)保持相同的形式，使用相同的三角函數萬能公式代換可求出θ2的解為

(16)

由于θ1的解有兩個，所以p3，q2的解有兩個，所以代入求θ2的解就有4種情況.得到θ1和θ2的解，把它們代入A1和A2中，就可以得到下端并聯機構變換矩陣AM1的形式.這樣就得到了下端并聯機構的位置正解.下端并聯模塊正解有4組解.

2.2 并聯模塊2的位置正解

上端并聯機構的位置正解可以通過和下部并聯機構類似的求解方法得到.首先，得到以下向量：

2O2B1=(b1x，b1y， 0， 1)T

(17)

2O2B2=(b， 0， 0， 1)T

(18)

5O5D1=(d1x，d1y， 0， 1)T

(19)

5O5D2=(d， 0， 0， 1)T

(20)

位置向量O2Di(i=1， 2)相對于坐標系O2X2Y2Z2可以寫成：

2O2Di=AM 25O5Di，i=1， 2

(21)

支鏈長度L4和L5(L4=B1D1，L5=B2D2)可以寫為

Lj=‖2O2Di-2O2Bi‖，i=1， 2；j=4， 5

(22)

將式(17)、(18)和式(21)所得的2O2D1、2O2D2代入式(22)就可以得到：

(d1xs4+d1yc4c5-b1y)2+

[d1y(c3s5+c5s3s4)+L6c3-d1xc4s3]2

(23)

(24)

將式(23)和(24)展開，并化簡可以得到下列兩個有關于未知角θ3和θ5的方程為

v1s3+v2c3=q3

(25)

w1s3+w2c3+w3s5+w4c5+
w5s3s5+w6c3c5+w7=0

(26)

式中：

式(25)是一個關于θ3的表達式.化簡式(25)并用三角函數萬能公式進行代換，得到θ3的解為

(27)

得到θ3的解之后，就可以將式(26)寫為

v3s5+v4c5=q4

(28)

式中：v3=w3+w5s3；v4=w4+w6c3；q4=-w1s3-w2c3-w7.

運用三角函數萬能公式，同理就可以求出θ5的解為

(29)

由θ3和θ5的表達式可知，θ3和θ5都有兩種表達形式，故θ3有兩組解，而θ5表達式中的v3、v4和q4都是關于θ3的表達式，將不同的θ3值代入v3、v4和q4中，會得到兩組不同的解，所以θ5也就有4組解.因此上部并聯機構模塊也有4種情形.

2.3 雙并聯型混聯機構的位置正解

此六自由度混聯機構的兩個并聯模塊都有4種位置正解，這樣每個并聯模塊都可以通過4種方式達到指定的位置.通過上述推導得到θ1，θ2，θ3和θ5的表達式，就可以求出整個六自由度混聯機構的位置正解變化矩陣A.

(30)

式中：

nx=c4(c1c3-c2s1s3)+s1s2s4；

ny=c2s4+c4s2s3；

nz=c1s2s4-c4(c3s1+c1c2s3)；

ox=s5(c1s3+c2c3s1)-c5[s4(c1c3-c2s1s3)-c4s1s2]；

oy=c5(c2c4-s2s3s4)-c3s2s5；

oz=c5[s4(c3s1+c1c2s3)+c1c4s2)-s5(s1s3-c1c2c3)；

ax=s5[s4(c1c3-c2s1s3)-c4s1s2]+c5(c1s3+c2c3s1)；

ay=-s5(c2c4-s2s3s4)-c3c5s2；

az=-s5[s4(c3s1+c1c2s3)+c1c4s2]-c5(s1s3-c1c2c3)；

px=L3s1+L6(c1s3+c2c3s1)；

py=-L6c3s2；

pz=L3c1-L6(s1s3-c1c2c3).

(31)

對于矩陣A前三行三列表示混聯機構末端執行器的姿態方程，式(31)為混聯機構的位置方程.

2.4 運動學正解特性數值分析算例

根據六自由度混聯機構的運動學位置正解，通過具體算例來驗證此混聯機構的位置正解.定義整個混聯機構的結構尺寸參數并給定一組驅動構件的輸入參數L1、L2、L3、L4、L5、θ4，根據運動學正解求解公式，采用數值法分別求出上下兩個并聯機構模塊的位置正解的解析解.分別得到上端和下端并聯機構模塊靜平臺和動平臺正三角形三個端點相對于世界坐標系的位置坐標，給出位姿的三維位姿圖，更加直觀地了解機構的位置和姿態.

給定整個混聯機構的尺寸參數如下：上下兩個并聯機構模塊的動平臺和靜平臺都是正三角形，假定下面并聯機構模塊的靜平臺邊長為0.5 m，動平臺的邊長為0.4 m.下端并聯機構模塊結構參數如表1所示.由于上端并聯機構模塊的靜平臺和下面并聯機構模塊的動平臺重合，所以上面并聯機構模塊的靜平臺邊長也為0.4 m，假定上面并聯機構模塊的動平臺邊長為0.3 m.上端并聯機構模塊的結構參數如表2所示.同時，上端并聯機構模塊的第三條支鏈長度給定L6=0.5 m.

表1 下端并聯機構模塊結構參數Table 1 Structure parameters of the lower parallel mechanism module mm

表2 上端并聯機構模塊結構參數Table 2 Structure parameters of the upper parallel mechanism module mm

給定六自由度混聯機構運動輸入如表3所示.

表3 混聯機構運動輸入Table 3 Input parameters of the hybrid mechanism

根據上述輸入，就可以得到下端并聯機構模塊的各端點相對于參考坐標系的位置坐標數值，如表4所示.上端并聯機構模塊各端點相對于參考坐標系的位置坐標數值，如表5所示.

上述分析得到了上下兩個并聯機構模塊動平臺和靜平臺各端點相對于各自靜平臺的位置坐標.由于上端并聯機構模塊的靜平臺與下端并聯機構模塊的動平臺重合，故將上端并聯機構模塊的靜平臺位置與下端并聯機構模塊的動平臺位置保持一致.只需將上端并聯機構模塊靜平臺的3個點B1、B2、B3的坐標值乘以變換矩陣AM1，就可以得到B1、B2、B3在坐標系OXYZ下的值.同理，將上述求得的D1、D2、D3點的坐標值也需要相應地乘以變換矩陣AM1，就可以得到如表6所示的D1、D2、D3點在坐標系OXYZ下的值.

表4 下端并聯機構模塊正解位置坐標Table 4 Position coordinate with forward kinematics of the lower parallel mechanism module

表5 上端并聯機構模塊的正解位置坐標Table 5 Position coordinate with forward kinematics of the upper parallel mechanism module

表6 坐標系OXYZ下的各坐標點算例Table 6 Numerical examples of all points in the OXYZ coordinate system

對于整個六自由度混聯機構，可以得到機構在此輸入狀態下的4種位姿情況，如圖3所示.這4種不同解析解情況下的位姿與表6給出的解析解對應.由圖4可以直觀地看出，第四組數值解支鏈之間不會發生干涉，符合要求.

(a) 第一組解 (b) 第二組解

(c) 第三組解 (d) 第四組解 圖3 雙并聯型混聯機構位姿正解算例

Fig.3Numericalexamplesofpositionandorientationofthehybridmechanism

3 混聯機構位置逆解分析

在給定雙并聯型混聯機構上平臺的位姿參數，求整個機構輸入關節的運動狀態是運動學位姿反解問題.求此混聯機構的位置反解，就是給定上端并聯機構模塊動平臺上末端的位姿，求解6個驅動，即5個移動副Li(i=1， 2， …， 5)和1個轉動副θ4.

3.1 雙并聯型混聯機構的位置逆解

假定給定混聯機構末端執行器的位姿用變換矩陣表示為

(32)

式中：px，py，pz表示固連在上端并聯機構模塊末端執行器上的坐標系O5X5Y5Z5原點O5的位置坐標.

由式(30)可以得到混聯機構的位置向量可以寫成p=(px，py，pz， 1)T，式中px，py，pz的值如式(31)所示.

(33)

代入展開可得：

(34)

令方程(34)左右兩邊的(1， 3)，(2， 3)，(3， 3)元素相等，可得：

axc5+oxs5=c1s3+s1c2c3

(35)

ayc5+oys5=-s2c3

(36)

azc5+ozs5=c1c2c3-s1s3

(37)

觀察發現式(31)中py的表達式與式(36)表達式右邊都有s2c3，所以把式(31)中py的表達式代入式(36)可以得到：

(38)

式中：q5=py/L6.

同理，將式(35)代入式(31)中px，式(37)代入式(31)中pz，可以得到：

L3s1=px-L6(axc5+oxs5)

(39)

L3c1=pz-L6(azc5+ozs5)

(40)

將式(39)和(40)左右兩邊同時取平方然后相加就可以得到驅動L3的表達式為

(41)

由于θ5有兩組解，故L3也就有兩組解.將L3的值代入式(39)和(40)中，從而可以得到θ1的表達式為

θ1=ATAN2(s1，c1)

(42)

(43)

由式(43)第二行第四列左右兩邊的元素相等可得：

pyc2-s2(L3-pxs1-pzc1)=0

(44)

從而可以得到θ2的表達式為

θ2=ATAN2[py， (L3-pxs1-pzc1)]

(45)

由θ2的表達式可知，θ2有兩組解.將式(31)中px的表達式寫成：

f1s3+f2c3=f3

(46)

由式(46)，并用三角函數萬能公式就可以得到θ3的表達式為

(47)

由θ3的表達式可知，θ3有兩組解.由式(43)所得的左右兩個矩陣，令第一行第一列左右兩邊的元素與第二行第一列左右兩邊的元素分別相等可得：

c4=nx(c1c3-s1c2s3)+nys2s3-nz(s1c3+c1c2s3)

(48)

s4=nxs1s2+nyc2+nzc1s2

(49)

從而就可以得到θ4的表達式為

θ4=ATAN2(s4，c4)

(50)

由式(38)、(42)、(45)、(47)、(50)就得到了θi(i=1， 2， …， 5) 的值，由此可以寫出所有的變換矩陣Ai(i=1， 2， …， 5)的表達式.從而可以寫出移動副驅動的表達式為

Li=‖OBi-OAi‖，i=1， 2

(51)

Lj=‖ODi-OBi‖，i=1， 2；j=4， 5

(52)

式中：OBi=A1A22O2Bi；ODi=A5O5Di.

至此，推導得到了六自由度雙并聯型混聯機構的運動學逆解.已知運動學輸出位姿，就可以求解得到機構5個移動副輸入L1、L2、L3、L4、L5和1個轉動副輸入θ4的解.由于θ5、θ2、θ3都有兩組解，所以此混聯機構具有8組解.

3.2 運動學逆解特性數值分析算例

根據雙并聯型混聯機構的位姿逆解的分析，給定混聯機構結構參數，然后給定動平臺的位置與姿態參數.選取與之前正解算例相同的結構參數，并且以混聯機構位置正解算例中得到的數值解作為反解的輸入，從而實現雙并聯型混聯機構位置正反解模型的相互驗證.

給定混聯機構的結構參數如表1和表2所示.由位置正解分析的三維模型位姿圖3可知，位置正解的第四組數值解支鏈之間不會發生干涉，符合要求.所以取i=4時的結果，此雙并聯型混聯機構的位姿變換矩陣為

將此時的位姿狀態作為輸入，代入雙并聯型混聯機構運動學逆解求解公式中，利用Matlab軟件求得各運動副的狀態如表7所示.

對逆解所得的8組數據進行分析可以發現,第八組輸入參數與位置正解算例中的第四組輸入參數相同.在此將兩組數據單獨提煉出來進行比較分析，如表8所示.

表7 六自由度混聯機構逆解數值解Table 7 Numerical examples of inverse kinematics of the 6-Dof hybrid mechanism

表8 六自由度混聯機構正逆解輸入數值解對比Table 8 Numerical solution comparison of forward and inverse solutions of the 6-Dof hybrid mechanism

經過比較之后發現，雙并聯型混聯機構的兩者之間存在微小誤差，且誤差可以忽略不計.

經過兩組解的對比，發現用正解得到的雙并聯型混聯機構末端位姿作為輸入，求得的機構驅動輸入參數與一開始求正解的輸入參數相同，兩者之間的誤差微乎其微.驗證了運動學正反解的正確性.

4 混聯機構工作空間分析

4.1 限制工作空間的因素

工作空間分析在混聯機構的分析中占有非常重要的地位[11].混聯機構工作空間會受到很多因素的影響，機構整體尺寸的大小，移動副P行程的約束，轉動副R轉角(包括虎克鉸U、球鉸S)角度值的限制，機構中各桿件之間的干涉現象都會對其產生影響[12].機構在不同的限定條件下，其工作空間的形狀和體積都會不一樣[13].不同的機構根據不同的用途和應用場合會提出不一樣的限制因素，每種因素的限制條件也不盡相同.在實際應用中，也會考慮成本因素提出不同的限制條件[14].

4.2 工作空間的算法描述

對本文混聯機構的位置可達工作空間進行分析，運用運動學反解分析結果，結合極限邊界數值搜索算法，求出其位置工作空間的形狀.求解位置工作空間內所有點的算法如圖4所示.給定合適的機構尺寸，通過圓柱坐標系逐個搜索，將Z坐標等分成n份，然后在每個Z坐標截面下，搜索邊界輪廓，直到在整個Z坐標下都搜索完成后，所有的邊界輪廓組合起來就是整個混聯機構的工作空間邊界圖[15].

圖4 工作空間算法流程圖Fig.4 Workspace algorithm flow chart

運用Matlab數學軟件采用上述的算法，結合混聯機構的運動學反解和約束條件對工作空間的算法進行編程，求解了給定算例的工作空間.

4.3 工作空間算例仿真

給定機構參數與運動學算例保持一致.針對此雙并聯型六自由度混聯機構，為了得到其位置工作空間，可以先將其末端固定在給定的姿態下，從而得到在此姿態下機構所能到達的所有滿足約束條件的位置空間.

(a) (15°， 15°， 15°)

(b) (20°， 20°， 20°)

(c) (25°， 25°， 25°)

(d) (30°， 30°， 30°) 圖5 不同姿態下的位置工作空間

Fig.5Positionworkspacewithdifferentorientation

由圖5可知，改變機構的姿態角，就可以得到不同定姿態的位置工作空間.這4種姿態條件下得到的位置工作空間邊界圖大致是一個從上到下邊界逐漸增大的近似拉長的連續錐形體.當姿態角達到(20°， 20°， 20°)時，機構的位置可達工作空間有一個凹洞，說明機構在此位置范圍內存在奇異位形.

根據定姿態位置工作空間圖可以看出該混聯機構位置在(0， 0， 1.3)時，具有較為規則的位置工作空間邊界，所以選擇在此位置進行機構的姿態工作空間搜索，其得到的姿態工作空間是指與末端執行器固結在一起的坐標系在該位置所能實現的所有的姿態坐標的集合，如圖6所示.

圖6 (0， 0， 1.3)時姿態工作空間Fig.6 Orientation workspace with the position (0， 0， 1.3)

5 結 論

(1) 本文介紹了雙并聯型六自由度混聯機構的結構，求解了機構的自由度數目.指定機構驅動構件，通過分別對下端并聯機構模塊和上端并聯機構模塊的運動學正解分析，得到整個混聯機構的運動學正解.通過給定機構結構參數和驅動輸入參數，用一組算例求得運動學動平臺位姿，并畫出三維機構位姿模型.然后求解運動學逆解，按照運動學正解結果，給定機構的兩組位姿，求得此時機構的驅動輸入參數及各轉動副的狀態，對比正反解結果，進而驗證了雙并聯型混聯機構運動學正反解模型的正確性.

(2) 根據混聯機構的運動學反解，利用極限邊界搜索法給出機構工作空間的算法.給定機構的結構參數，考慮工作空間影響因素，利用數值搜索法在圓柱坐標系中搜索工作空間的邊界.在Matlab軟件中仿真得到了混聯機構在給定不同姿態下的位置工作空間和給定位置下的姿態工作空間.

[1] 姜銘，孫釗，秦康生，等.混聯機器人的分析與研究[J].制造業自動化，2009，31(1)：61-65.

[2] 傘紅軍.新型五軸并串聯機床的運動學分析與結構參數設計[D].哈爾濱：哈爾濱工業大學機電工程學院，2009.

[3] 高建設，李明祥，侯伯杰，等.新型四足步行機器人串并混聯腿的運動學分析[J].光學精密工程，2015，23(11)：3147-3160.

[4] PISLA D， SZILAGHYI A， VAIDA C， et al. Kinematics and workspace modeling of a new hybrid robot used in minimally invasive surgery[J]. Robotics and Computer-Integrated Manufacturing， 2013， 29(2)：463-474.

[5] ZENG Q， FANG Y. Structural synthesis and analysis of serial-parallel hybrid mechanisms with spatial multi-loop kinematic chains[J]. Mechanism & Machine Theory， 2012， 49(3)：198-215.

[6] CHANGYA YAN， FENG GAO， YONG ZHANG. Kinematic modeling of a serial-parallel forging manipulator with application to heavy-duty manipulations#[J]. Mechanics Based Design of Structures & Machines， 2010， 38(1)：105-129.

[7] 劉海濤，黃田，CHETWYND D G，等.5自由度大工作空間/支鏈行程比混聯機械手的概念設計與尺度綜合[J].機械工程學報，2007，43(6)：14-20.

[8] LU Y， DAI Z， YE N， et al. Kinematics/statics analysis of a novel serial-parallel robotic arm with hand[J]. Journal of Mechanical Science & Technology， 2015， 29(10)：4407-4416.

[9] 石巖，路懿.一種2SPS+RPRR并聯機構的運動學與工作空間分析[J].燕山大學學報，2010，34(1)：18-23.

[10] 黃真，劉婧芳，李艷文.論機構自由度[M].科學出版社，2011.

[11] CAMMARATA A. Optimized design of a large-workspace 2-DOF parallel robot for solar tracking systems[J]. Mechanism & Machine Theory， 2015， 83：175-186.

[12] 韓方元.并聯機器人運動學正解新算法及工作空間本體研究[D].長春：吉林大學機械科學與工程學院，2011.

[13] HAY A M， SNYMAN J A. A multi-level optimization methodology for determining the dextrous workspaces of planar parallel manipulators[J]. Structural & Multidisciplinary Optimization， 2005， 30(30)：422-427.

[14] 黃秀琴，辛秀梅，沈惠平，等.一種新型3自由度并聯機構的設計和運動學分析[J].機械設計，2010，27(7)：4-6.

[15] 陳偉海，徐穎俊，王建華，等.并聯式下肢康復外骨骼運動學及工作空間分析[J].機械工程學報，2015，51(13)：158-166.

KinematicAnalysisofa6-DoFHybridMechanism

ZHOUHui1， 3，ZHOURui1， 3，ZHUJingyuan1， 3，DINGZehua1， 3，CAOHaofeng1， 3，CAOYi1， 2， 3

(1. School of Mechanical Engineering， Jiangnan University， Wuxi 214122， China；2. Key Laboratory of System Control and Information Processing， Shanghai Jiao Tong University， Shanghai 200240， China；3. Jiangsu Key Laboratory of Advanced Food Manufacturing Equipment and Technology， Wuxi 214122， China)

Hybrid mechanisms combine the advantages of parallel mechanisms and series mechanisms， which can effectively expand the application field of robot. A hybrid mechanism is presented, which is combined by two different 3-DoF parallel mechanisms connected in series. Through the analysis of the kinematics of the upper and lower parallel modules， the forward kinematics solution of the whole hybrid mechanism is obtained. A set of numerical examples of position and posture of the moving platform is obtained by given the structural parameters and driving parameters， meanwhile， the 3D models of the mechanism are obtained in order to more intuitive understanding of the mechanism. Then the inverse kinematics solution is solved. According to the forward kinematic results， a group of position and posture is given to obtain the driving input parameters of the mechanism and the state of each rotation pair， by compared with the result of the forward and inverse solutions， the correctness of the forward and inverse solution is verified. Finally， on the basis of kinematics analysis， using limit coordinate searching method， algorithm of working space is put out. Considering the length constraints， joint constraint and the interference of the member， the boundary of workspace is obtained in cylindrical coordinates by given the structural parameters. Position workspace respect to a variety of postures posture and orientation-workspace respect to a variety of positions are simulated in Matlab.

hybrid mechanism； kinematics； limit coordinate search method； workspace

1671-0444 (2017)05-0709-11

2016-06-17

國家自然科學基金資助項目(50905075)；機械系統與振動國家重點實驗室開放課題資助項目(MSV201407)；江蘇省食品先進制造裝備技術重點實驗室開放課題資助項目(FM-201402)

周 輝(1973—)，女，河北秦皇島人，講師，碩士，研究方向為混聯機器人機構學理論及機器人技術.E-mail：roboticscenter@qq.com

曹 毅(聯系人)，男，教授，E-mail：caoyi@jiangnan.edu.cn

TH 112

A

(責任編輯：杜佳)