趙德勝, 吳榮軍
(西安郵電大學(xué) 自動(dòng)化學(xué)院, 西安 710121)
?
含2個(gè)S副間隙6-SPS機(jī)構(gòu)奇異性分析
趙德勝, 吳榮軍
(西安郵電大學(xué) 自動(dòng)化學(xué)院, 西安710121)
摘要:6-SPS機(jī)構(gòu)位姿矩陣采用四元數(shù)法描述,并將該矩陣和矢量坐標(biāo)擴(kuò)展為4維形式,推導(dǎo)出無間隙機(jī)構(gòu)的運(yùn)動(dòng)方程,得到了機(jī)構(gòu)運(yùn)動(dòng)的新型雅克比矩陣JA和JB;在此基礎(chǔ)上,利用連續(xù)接觸模型得到了兩個(gè)含間隙S副共連桿和異桿時(shí)機(jī)構(gòu)的運(yùn)動(dòng)系數(shù)矩陣。分別把各個(gè)運(yùn)動(dòng)系數(shù)的行列式展開,得到含間隙機(jī)構(gòu)第一類奇異和第二類奇異的軌跡方程,利用MATLAB得到了機(jī)構(gòu)在給定位置時(shí)的第一類位姿奇異軌跡和第二類位姿奇異三維軌跡曲面;通過將兩類含間隙機(jī)構(gòu)奇異軌跡曲面的比較,發(fā)現(xiàn)機(jī)構(gòu)間隙對(duì)第二類奇異的影響大于對(duì)第一類奇異的影響;在兩類奇異軌跡中,當(dāng)S副異桿時(shí),機(jī)構(gòu)間隙的影響均大于S副共連桿時(shí)的影響。以無間隙機(jī)構(gòu)奇異軌跡曲面上奇異點(diǎn)作為參考點(diǎn),通過含間隙機(jī)構(gòu)奇異軌跡曲面上與參考點(diǎn)相對(duì)應(yīng)奇異點(diǎn)的相互比較,發(fā)現(xiàn)存在一個(gè)關(guān)于參考點(diǎn)的奇異域。
關(guān)鍵詞:四元數(shù); 奇異位形; 含間隙并聯(lián)機(jī)構(gòu);雅克比矩陣;奇異域
并聯(lián)機(jī)器人具有多自由度、大承載力、精度高等優(yōu)點(diǎn),在現(xiàn)代工業(yè)生產(chǎn)中得到越來越廣泛的應(yīng)用。奇異位形是機(jī)構(gòu)的一個(gè)固有屬性,當(dāng)并聯(lián)機(jī)構(gòu)處于奇異位形時(shí),機(jī)構(gòu)自由度發(fā)生變化,給運(yùn)動(dòng)控制帶來困難[1]。自20世紀(jì)90年代就有學(xué)者發(fā)現(xiàn),并聯(lián)機(jī)構(gòu)的奇異位形并不只是工作空間中的一些孤立點(diǎn),還找到了一系列連續(xù)變化的奇異位形,稱為奇異軌跡[2-3]。一些研究者近年來對(duì)并聯(lián)機(jī)構(gòu)進(jìn)行了深入研究,發(fā)現(xiàn)其雅克比矩陣行列式展開后十分復(fù)雜。國內(nèi)學(xué)者基于螺旋理論建立雅克比矩陣研究了Stewart并聯(lián)機(jī)構(gòu)的位置奇異軌跡,得出了姿態(tài)奇異軌跡的解析表達(dá)式。但是,這種方法得出的雅克比矩陣不僅所含項(xiàng)數(shù)多而且含有超越項(xiàng),難以求解。目前,對(duì)并聯(lián)機(jī)構(gòu)的奇異性研究方法還不成熟,需要從結(jié)構(gòu)設(shè)計(jì)和理論創(chuàng)新方面進(jìn)行突破[4-6]。
機(jī)構(gòu)奇異位形的存在對(duì)機(jī)構(gòu)的運(yùn)動(dòng)、受力等各個(gè)方面均產(chǎn)生了較大影響,嚴(yán)重時(shí)可能損壞機(jī)構(gòu)。因此,專家們不得不提出各種免奇異研究方法。但是,很多免奇異方法沒有考慮機(jī)構(gòu)間隙對(duì)奇異位形的影響。機(jī)構(gòu)間隙的存在不僅影響機(jī)構(gòu)運(yùn)動(dòng)精度而且對(duì)機(jī)構(gòu)的奇異位形也有較大影響。本文利用四元數(shù)法對(duì)含間隙6—SPS機(jī)構(gòu)的奇異位形進(jìn)行了研究。
本文出于以下兩個(gè)原因只考慮2個(gè)球面副的間隙:① 在該并聯(lián)機(jī)構(gòu)中球面副相對(duì)其他運(yùn)動(dòng)副更加普遍且位于驅(qū)動(dòng)支鏈上,對(duì)其進(jìn)行研究更顯一般性。② 為了簡化計(jì)算和方便公式推導(dǎo)。
1四元數(shù)與位姿矩陣
四元數(shù)的一般形式為:
ε=ε0+ε1i+ε2j+ε3k
(1)
式中:ε,ε0,ε1,ε2,ε3∈R。采用單位四元數(shù)描述并聯(lián)機(jī)構(gòu)動(dòng)平臺(tái)的姿態(tài),對(duì)應(yīng)變換矩陣R為[12]:
(2)
將3階變換矩陣R擴(kuò)展為4階形式:
(3)
(4)
(5)
為了下文的雅克比矩陣轉(zhuǎn)化方便,預(yù)定義4維矢量:h=(h1h2h3h4)T,由式(5)可得:
(6)
式中:P為動(dòng)坐標(biāo)系的原點(diǎn)O′在慣性系O-XYZ((見圖1)中的位置矢量。
2無間隙機(jī)構(gòu)運(yùn)動(dòng)學(xué)方程
為了便于分析含間隙機(jī)構(gòu)奇異位形特點(diǎn),首先分析無間隙機(jī)構(gòu)的奇異位形,以便二者比較。
2.16-SPS機(jī)構(gòu)簡圖及平臺(tái)頂點(diǎn)參數(shù)
圖1為該機(jī)構(gòu)的機(jī)構(gòu)簡圖,表1給出了機(jī)構(gòu)各頂點(diǎn)在動(dòng)坐標(biāo)系和慣性坐標(biāo)系中的坐標(biāo)參數(shù)。
圖1 6-SPS機(jī)構(gòu)簡圖Fig.1 6-SPS parallel mechanism diagrammatic sketch
圖1中:坐標(biāo)系O-XYZ為慣性坐標(biāo)系(定坐標(biāo)系),固聯(lián)與定平臺(tái);O′-X′Y′Z′為動(dòng)坐標(biāo)系,固聯(lián)與動(dòng)平臺(tái)。表1是動(dòng)靜平臺(tái)各個(gè)頂點(diǎn)的X和Y軸坐標(biāo)參數(shù),是事先給定的數(shù)值;動(dòng)平臺(tái)各個(gè)頂點(diǎn)的X和Y軸坐標(biāo)值由參數(shù)θ2和動(dòng)平臺(tái)頂點(diǎn)外接圓半徑r2確定。靜平臺(tái)各個(gè)頂點(diǎn)的X和Y軸坐標(biāo)值由參數(shù)θ1和靜平臺(tái)頂點(diǎn)外接圓半徑r1確定。
表1 動(dòng)靜平臺(tái)各頂點(diǎn)坐標(biāo)參數(shù)
2.2運(yùn)動(dòng)學(xué)方程推導(dǎo)
在已得到動(dòng)平臺(tái)位姿矩陣R(式(2))的基礎(chǔ)上,令位置矢量P=(PxPyPz)T,其中Px、Py、Pz為P在各軸的分量。則動(dòng)平臺(tái)和定平臺(tái)對(duì)應(yīng)頂點(diǎn)之間的連桿矢量為:
lkek=P+Rak-bk
(7)
式中:lk為連桿AkBk的長度,k=1~6;ak為動(dòng)平臺(tái)頂點(diǎn)在動(dòng)坐標(biāo)系中的矢量,k=1~6;bk為靜平臺(tái)頂點(diǎn)在靜坐標(biāo)系中的矢量,k=1~6;ek為連桿AkBk的單位矢量,k=1~6。
由式(4)和式(7)可得:
(8)
又由式(6)可得:
(9)
式中:Q是動(dòng)平臺(tái)在動(dòng)坐標(biāo)系O′-X′Y′Z′(見圖1)中的位置矢量。式(7)兩邊點(diǎn)乘自身,并將頂點(diǎn)坐標(biāo)代入可得:
2(axkbxk-aykbyk)(2ε0ε3)+2aykQy+PP-
2(axkbxk+aykbyk)(2ε1ε2)-2bxkPx-2bykPy
(10)
式中:ra為動(dòng)平臺(tái)各頂點(diǎn)矢徑,ra=1.2。rb為靜平
臺(tái)平臺(tái)各頂點(diǎn)矢徑,rb=2(本文中動(dòng)、靜平臺(tái)均為正六邊形)。Qx、Qy、Qz為Q在各軸的分量。
由式(6)和式(9)可得:
Px=h1ε0-h0ε1-h3ε2+h2ε3
Py=h2ε0-h0ε2+h3ε1-h1ε3
Qx=h1ε0-h0ε1+h3ε2-h2ε3
Qy=h2ε0-h0ε2-h3ε1+h1ε3
又由式(10)包含6個(gè)類似方程,將表1中各頂點(diǎn)參數(shù)代入整理得到式(11):
Mat1η1=Mat2η2+L
(11)
式中:
L為桿長矩陣,
在Mat2中,
由此將式(11)整理可得:
令
由此可得:
(12)
在式(12)中含有6個(gè)方程,8個(gè)輸入變量。為了得到運(yùn)動(dòng)學(xué)運(yùn)動(dòng)系數(shù)方陣,又根據(jù)單位四元數(shù)的性質(zhì):
(13)
把式(12)和式(13)合并成式(14):
(14)
對(duì)式(14)兩邊求導(dǎo)可得:
JAVε=JBVs
(15)
(16)
(17)
3含間隙機(jī)構(gòu)運(yùn)動(dòng)學(xué)方程推導(dǎo)
3.1兩個(gè)含間隙S副異桿
在含間隙S副B1點(diǎn)處建立坐標(biāo)系OB1-XB1YB1ZB1(見圖2)。
式中:OB1為無間隙時(shí)與B1點(diǎn)對(duì)應(yīng)的理想頂點(diǎn);O為原定平臺(tái)中心;OB1b1為XB1軸最大間隙Lexmax;OB1a1為A1B1連桿最大間隙Lezmax;OB1b2、OB1b6表示YB1軸向上定平臺(tái)B1B2、B6B1邊長的最大間隙Leymax。
假設(shè):
(1) 第一、第二支鏈的定平臺(tái)S運(yùn)動(dòng)副含有間隙,并把各個(gè)軸向間隙矢量簡化為一個(gè)無剛度連桿。
(3) 假設(shè)在三個(gè)坐標(biāo)軸方向上機(jī)構(gòu)間隙最大值相等,即Lexmax=Leymax=Lezmax。
(4) 兩個(gè)S副在各個(gè)坐標(biāo)軸方向的間隙最大值相等。
(5) 機(jī)構(gòu)間隙變化速度最大值相等。由此得第一和第二連桿支鏈?zhǔn)噶糠匠虨椋?/p>
(li+lz)ei=P+Rai-(bi+le)
(18)
式中:i=1,2。
整理后可得式(19):
(axi(bxi+lex))-ayi(byi+ley))-
2(axi(bxi+lex)-ayi(byi+ley))(2ε0ε3)+2ayiQy+PP-
2(axi(bxi+lex)+ayi(byi+ley))(2ε1ε2)-
2(bxi+lex)Px-2(byi+ley)Py
(19)
式中:i=1,2。式(19)中:等式左邊系數(shù)接近于0的項(xiàng)被省略。
圖3 含間隙運(yùn)動(dòng)副平面連桿機(jī)構(gòu)示意圖Fig.3 Mechanism with clearance diagrammatic sketch
由圖3可知,Lex+Ob1=(A1B1+Lez)cosα+O′A1+OO′cosβ,兩邊求導(dǎo)得:
Ve=
JAS1Vε=JBS1Vs
(20)
式中:
3.2兩個(gè)含間隙S副共連桿
假設(shè):
(1) 第一連桿支鏈的兩個(gè)S運(yùn)動(dòng)副含有間隙(其簡圖見圖2,把各個(gè)軸向間隙矢量簡化為一個(gè)無剛度連桿。
(4) 兩個(gè)S副同坐標(biāo)軸方向間隙最大值相等,即Lexmax=Leymax=Lezmax。
(5) 機(jī)構(gòu)各個(gè)間隙變化速度最大值相等。由此得第一連桿支鏈?zhǔn)噶糠匠虨椋?/p>
(l1+lz)e1=P+R(a1+le)-(b1+le)
(21)
整理后可得:
(ay1+ley)(by1+ley))-
(ay1+ley)(by1+ley))+
2(ax1+lex)Qx-2(by1+ley)Py+
2((ax1+lex)(bx1+lex)-
(ay1+ley)(by1+ley))(2ε0ε3)+
2(ay1+ley)Qy+PP-2((ax1+lex)(bx1+lex)+
(ay1+ley)(by1+ley))(2ε1ε2)-2(bx1+lex)Px
(22)
由式(10)、式(22)可得含間隙機(jī)構(gòu)運(yùn)動(dòng)學(xué)方程:
JAS2Vε=JBS2Vs
(23)
式中:
4奇異位形分析
4.1第一類奇異
4.1.1奇異軌跡曲面
(21)
det(JA)=0的展開式可表示為:
f(U,V,W,Px,Py,Pz)=0
(22)
圖4為一個(gè)給定位置時(shí)的奇異軌跡曲面。同樣,根據(jù)含間隙機(jī)構(gòu)的運(yùn)動(dòng)系數(shù)矩陣JAS1、JAs2,在機(jī)構(gòu)間隙最大值相等的條件下,得到兩S副異桿和共桿時(shí)的第一類奇異軌跡曲面(見圖5、圖6)。以圖4為參考,圖6的變化較大;另外,由表2、表3、表4可知,相對(duì)于表1中參考點(diǎn)的坐標(biāo)值,表4中點(diǎn)的坐標(biāo)值變化大于表3中的點(diǎn)。說明兩個(gè)間隙S副異桿時(shí)對(duì)機(jī)構(gòu)奇異位形影響較大。
表2 無間隙機(jī)構(gòu)奇異點(diǎn)坐標(biāo)值
表3 含間隙S副共桿e=0.06奇異點(diǎn)坐標(biāo)值
表4 含間隙S副異桿e=0.06奇異點(diǎn)坐標(biāo)值
圖4 Px=1,Py=2,Pz=2Fig.4 Px=1,Py=2,Pz=2
圖5 含間隙S副共桿e=0.06,Px=1,Py=2,Pz=2Fig.5 S pairs with clearance in a same linkage e=0.06,Px=1,Py=2,Pz=2
圖6 含間隙S副異桿e=0.06,Px=1,Py=2,Pz=2Fig.6 S pairs with clearance in a different linkage e=0.06,Px=1,Py=2,Pz=2
4.1.2點(diǎn)的奇異域
取機(jī)構(gòu)間隙e=0時(shí),奇異軌跡曲面上的第一個(gè)點(diǎn)為參考點(diǎn)A。
當(dāng)機(jī)構(gòu)間隙e=0.06時(shí),提取若干組奇異曲面上的與之相對(duì)應(yīng)點(diǎn)的坐標(biāo),通過觀察點(diǎn)的坐標(biāo)值變化,發(fā)現(xiàn)不同曲面上的與參考點(diǎn)對(duì)應(yīng)的點(diǎn)均分布在參考點(diǎn)A附近(見圖7),圖中用黑色矩形表示點(diǎn)為參考點(diǎn))。即存在一個(gè)包含參考點(diǎn)A的點(diǎn)奇異域。在這個(gè)區(qū)域內(nèi)的任意一點(diǎn),在機(jī)構(gòu)運(yùn)動(dòng)時(shí)都可能成為奇異點(diǎn)(見圖7、圖8)。但是,S副共連桿時(shí)的奇異域基本以參考點(diǎn)為中心;S副異桿時(shí)參考點(diǎn)只是其中一個(gè)普通點(diǎn)。
圖7 不共連桿參考點(diǎn)奇異域圖Fig.7 S pairs with clearance in a different linkage e=0.06,the reference point’s singular area
圖8 共連桿參考點(diǎn)奇異域圖Fig.8 S pairs with clearance in a same linkage e=0.06,the reference point’s singular area
4.2第二類奇異
4.2.1奇異軌跡曲面
同樣,首先研究無間隙機(jī)構(gòu)的奇異軌跡曲面。當(dāng)det(JA)≠0 ,det(JB)=0 時(shí),為第二類奇異。系數(shù)矩陣JB中取θ1=π/6 、θ2=π/12。展開det(JB)=0可得第二類奇異軌跡方程。圖9為給定條件下的無間隙機(jī)構(gòu)奇異軌跡曲面。圖10、圖11是在相同條件下根據(jù)含間隙機(jī)構(gòu)的運(yùn)動(dòng)系數(shù)矩陣JBS1和JBS2得到的含間隙機(jī)構(gòu)第二類奇異軌跡曲面。
通過比較圖12、圖13,同樣說明在第二類奇異中,相對(duì)于參考點(diǎn)附近也存在一個(gè)奇異域。通過提取大量不同曲面上與參考點(diǎn)相對(duì)應(yīng)的奇異點(diǎn)并進(jìn)行比較,兩種情況下,奇異域基本以參考點(diǎn)為中心。另外,由圖11可知,含間隙S副異桿時(shí),間隙對(duì)奇異位形的影響較大。
4.2.2兩類奇異軌跡曲面的比較
對(duì)比圖5和圖6、圖10和圖11,在機(jī)構(gòu)間隙相同的情況下,圖10、圖11相對(duì)于圖9的變化差異大于圖5、6相對(duì)于圖4的變化差異,說明機(jī)構(gòu)間隙對(duì)第二類奇異的影響大于對(duì)第一類奇異的影響。
圖9 l2=6,l4=6,l6=3Fig.9l2=6,l4=6,l6=3圖10 含間隙S副共桿e=0.06,l2=6,l4=6,l6=3Fig.10Spairswithclearanceinasamelinkagee=0.001,l2=6,l4=6,l6=3圖11 含間隙S副異桿e=0.06,l2=6,l4=6,l6=3Fig.11Spairswithclearanceinadifferentlinkagee=0.06,l2=6,l4=6,l6=3
圖12 含間隙S副異桿Fig.12 S pairs with clearance in the different linkage
圖13 含間隙S副共桿 Fig.13 S pairs with clearance in the same linkage
5結(jié)論
(1) 本文利用連續(xù)接觸模型得到了由四元數(shù)表示的含間隙機(jī)構(gòu)運(yùn)動(dòng)方程的雅克比矩陣。
(2) 通過比較含間隙機(jī)構(gòu)與無間隙機(jī)構(gòu)奇異軌跡曲面以及曲面上對(duì)應(yīng)點(diǎn)的坐標(biāo)值,說明機(jī)構(gòu)間隙對(duì)機(jī)構(gòu)的奇異位形有一定影響。
(3) 通過比較含間隙機(jī)構(gòu)的第一類和第二類奇異軌跡曲面,證明機(jī)構(gòu)間隙對(duì)第二類奇異的影響大于對(duì)第一類奇異的影響;并且兩個(gè)S副位于不同的支鏈時(shí)對(duì)奇異位形的影響比位于同一支鏈上時(shí)影響大。
(4) 通過提取不同軌跡曲面上的對(duì)應(yīng)奇異點(diǎn)以及對(duì)其坐標(biāo)值的比較,證明在參考點(diǎn)附近存在一個(gè)奇異域。在奇異域內(nèi)任意一點(diǎn)都可能產(chǎn)生奇異。
以上研究為機(jī)構(gòu)的免奇異研究提供參考。
參 考 文 獻(xiàn)
[ 1 ] 艾青林,祖順江,胥芳.并聯(lián)機(jī)構(gòu)運(yùn)動(dòng)學(xué)與奇異性研究進(jìn)展[J].浙江大學(xué)學(xué)報(bào):工學(xué)版,2012,46(8):1345-1353.
AI Qing-lin,ZU Shun-jiang, XU Fang. Review of kinematics and singularity of parallel manipulator[J].Journal of Zhejiang University:Engineering Science,2012, 46(8):1345-1353.
[ 2 ] Cheng Shi-li,Wu Hong-tao, Wang Chao-kun, et al. A novel method for singularity analysis of the 6-SPS parallel mechanisms[J].Science China, 2011,54 (5):1220-1227.
[ 3 ] 吳鑫,陳美麗,張彥斌.2T1R并聯(lián)機(jī)構(gòu)位置及奇異性分析[J].農(nóng)業(yè)機(jī)械學(xué)報(bào),2010,41(2):208-213.
WU Xin,CHEN Mei-li,ZHANG Yan-bin. Analysis of position and singularity of a parallel mechanism with three degrees of freedom[J].Transactions of the Chinese Society for Agricultural Machinery,2010,41(2):208-213.
[ 4 ] 王庚祥,劉宏昭.考慮球面副間隙的4-SPS/CU并聯(lián)機(jī)構(gòu)動(dòng)力學(xué)分析[J].機(jī)械工程學(xué)報(bào),2015,51(1):43-51.
WANG Geng-xiang, LIU Hong-zhao. Dynamics analysis of 4-SPS/CU parallel mechanism with spherical joint clearance[J].Journal of Mechanical Engineering,2015,51(1):43-51.
[ 5 ] 李雨桐,王玉新.力作用下并聯(lián)機(jī)構(gòu)奇異點(diǎn)動(dòng)態(tài)穩(wěn)定性[J].機(jī)械工程學(xué)報(bào),2013,49(3):12-18.
LI Yu-tong, WANG Yu-xin. Dynamic stability of the parallel manipulator at turning point singularities under applied loads and gravities[J].Journal of Mechanical Engineering,2013,49(3):12-18.
[ 6 ] 陳江義,郝雪清,虞啟輝.含間隙鉸鏈并聯(lián)機(jī)構(gòu)的動(dòng)力學(xué)分析[J].鄭州大學(xué)學(xué)報(bào):工學(xué)版,2012,33(1):98-102.
CHEN Jiang-yi, HAO xue-qin, YU Qi-hui. Dynamic analysis of parallel mechanism with clearance revolute joint[J]. Journal of Zhengzhou University:Engineering Science, 2012,33(1):98-102.
[ 7 ] 王威,沈政,宋玉玲,等.含間隙和干摩擦的連桿機(jī)構(gòu)系統(tǒng)動(dòng)力學(xué)研究[J].振動(dòng)與沖擊,2015,34(18): 210-214.
WANG Wei, SHEN Zheng, SONG Yu-ling, et al. System dynamics linkage mechanism with clearance and dry friction[J].Journal of Vibration and Shock,2015,34(18): 210-214.
[ 8 ] 李保坤,曹毅,黃真,等.基于四元數(shù)的6-SPS并聯(lián)機(jī)器人姿態(tài)奇異研究[J].安徽理工大學(xué)學(xué)報(bào):自然科學(xué)版,2006,26(4):12-17.
LI Bao-kun, CAO Yi, HUANG Zhen, et al. Orientation-singularity analysis of 6-SPS parallel manipulator using unit quaternion[J].Journal of Anhui University of Science and Technology:Natural Science,2006,26(4):12-17.
[ 9 ] 周玉林,高峰.3-RRR 3自由度球面機(jī)構(gòu)靜剛度分析[J]. 機(jī)械工程學(xué)報(bào), 2009, 45 (4): 25-31.
ZHOU Yu-lin, GAO Feng. Stiffness analysis of spherical parallel mechanism 3RRR with 3 DOF[J].Journal of Mechanical Engineering, 2009, 45 (4): 25-31.
[10] 趙德勝,張雪,李彩琴.一種新型助力機(jī)器人奇異位形分析[J].機(jī)械傳動(dòng),2013,37(10):82-85.
ZHAO De-sheng, ZHANG Xue, LI Cai-qin. Analysis of singularity of a novel powered robot[J].Journal of Mechanical Transmission,2013,37(10):82-85.
[11] 趙德勝,李彩琴,張雪.間隙對(duì)曲柄滑塊機(jī)構(gòu)靈敏度的影響研究[J].西安郵電學(xué)院學(xué)報(bào),2011,16(5):98-100.
ZHAO De-sheng, LI Cai-qin, ZHANG Xue. Influence of clearance on sensitivity of crank-slider mechanism[J].Journal of Xi’an University of Posts and Telecommunications,2011,16(5):98-100.
[12] 賈書惠.剛體動(dòng)力學(xué)[M].北京:高等教育出版杜,1987.
Singularity analysis for a 6-SPS mechanism with 2 S-pairs containing clearance
ZHAODe-sheng,WURong-jun(School of Automation, Xi’an University of Posts & Telecommunications, Xi’an 710121, China)
Abstract:The pose matrix of a 6-SPS mechanism was described with the quaternion method. The matrix and vector coordinates were expanded into a 4-dimensional form to derive the motion equations of the mechanism without clearance. Then, the novel kinematic Jacobi matrixes JA and JB of the mechanism motion were achieved. On this basis, the movement coefficient matrixes of two S-pairs co-linkage and a different-linkage mechanism were derived with the continuous contact model. Determinants of movement coefficients were expanded, respectively. Subsequently, the trajectory equations containing the first category of singularity and the second category of singularity of mechanisms containing clearance were derived, respectively. Using MATLAB software, the three-dimensional track surfaces of the first category and the second category of pose-attitude singular trajectories at a given location of the mechanism were obtained. The comparison between two types of singularity trajectory surfaces of mechanisms containing clearance showed that the influence of mechanism clearance on the second category of singular it is greater than that on the first category; among the two types of singularity tracks, the influence of mechanism clearance in different-linkage S pairs is greater than that in co-linkage S pairs; the singular point on the trajectory surface of a mechanism without clearance is taken as a reference point, comparing the singular points on the singularity trajectory surface of a mechanism containing clearance corresponding to the reference point, a singular area with respect to the reference point can be found.
Key words:quaternion;singularity; parallel mechanism with clearance; Jacobi matrix; singular area
中圖分類號(hào):THl12
文獻(xiàn)標(biāo)志碼:A
DOI:10.13465/j.cnki.jvs.2016.07.020
收稿日期:2015-08-07修改稿收到日期:2015-09-28
基金項(xiàng)目:陜西省教育廳2014科學(xué)研究計(jì)劃基金資助項(xiàng)目 (14JK1655)
第一作者 趙德勝 男,講師,博士,1974年生