混聯(lián)碼垛機器人的結(jié)構(gòu)設(shè)計與位姿誤差分析

周文全，李開明

(南京理工大學(xué)機械工程學(xué)院，江蘇 南京 210094)

由于碼垛作業(yè)重復(fù)、單調(diào)，貨物的質(zhì)量遠(yuǎn)超人力范圍，且部分作業(yè)場所具有一定的危險性，因此碼垛機器人的使用開始普及。

目前市面上的碼垛機器人的構(gòu)型主要以串聯(lián)機構(gòu)為主，如ABB公司的IRB 6650S型碼垛機器人[1]和KUKA公司的KR titan PA系列[2]，串聯(lián)機構(gòu)往往承載能力小且存在累積誤差，不太適合重型貨物搬運的場合；而以并聯(lián)機構(gòu)為主的碼垛機器人雖然沒有累積誤差且承載能力較大，但受限于結(jié)構(gòu)，可能出現(xiàn)運動規(guī)律難以把握、工作空間小等問題。因此，本文引入一款自主設(shè)計的混聯(lián)碼垛機器人，該機器人由底座、2(2-RPR)并聯(lián)機構(gòu)、工作平臺等組成，其工作平臺上安裝有回轉(zhuǎn)軸，可讓被抓取的物體擁有一個轉(zhuǎn)動自由度；該機器人不僅能提高整體的承載能力，抓取較重的物體，同時保證有足夠的運動空間，能夠最大程度抓取各個方位的物品。

碼垛機器人除了需要具備一定的承載能力以及足夠大的運動空間，還需要提高機器人的運動精度。而提高機器人的運動精度就要對機器人進行誤差分析，只有針對具體的機器人機構(gòu)建立合適的位姿誤差模型，才能為后續(xù)提高機器人精度提供理論基礎(chǔ)。本文利用攝動法的相關(guān)理論，建立該混聯(lián)機器人的位姿誤差模型[3-6]，然后利用MATLAB軟件編程驗證誤差模型，確定誤差源的大小對機器人末端位姿誤差的影響情況[7-10]。

1 碼垛機器人的整體機構(gòu)

如圖1所示，該混聯(lián)碼垛機器人由底座、回轉(zhuǎn)支承、電動缸支架、2(2-RPR)并聯(lián)機構(gòu)、工作平臺等部分組成。其中底座與電動缸支架之間安裝有腰部回轉(zhuǎn)電機，帶動電動缸支架及其上的各裝置做旋轉(zhuǎn)運動；2(2-RPR)并聯(lián)機構(gòu)的兩端通過鉸鏈分別與電動缸支架以及動平臺相連；工作臺的下部安裝有由電機驅(qū)動的旋轉(zhuǎn)軸，可借助法蘭盤與各類夾取裝置固連，從而更好地完成不同的碼垛搬運工作。

圖1 碼垛機器人三維模型

其中，2(2-RPR)并聯(lián)機構(gòu)包括兩組平行雙聯(lián)同步伸縮電動缸，它們的布置形式不同，一組平行雙聯(lián)同步伸縮電動缸所在平面與回轉(zhuǎn)支承的軸線平行，而另一組所在平面與前一組所在平面垂直。同時，2(2-RPR)并聯(lián)機構(gòu)的兩端部各通過兩個鉸鏈分別與電動缸支架、動平臺聯(lián)接。

如圖2所示，平行雙聯(lián)同步伸縮電動缸的規(guī)格完全相同，由同一個交流伺服電機通過同步帶輪驅(qū)動錐齒輪換向器，進而帶動電動缸內(nèi)部的絲杠螺母運動，最終實現(xiàn)兩個電動缸的同步伸縮。

圖2 平行雙聯(lián)同步伸縮電動缸

在整個碼垛機器人工作過程中，動平臺上旋轉(zhuǎn)軸的軸線始終與地面垂直。因此，該機器人的末端僅有4個活動自由度，即三方向的平移和一方向的旋轉(zhuǎn)。雖然該混聯(lián)機器人的末端自由度相比于常見的六自由度串聯(lián)機器人較少，但對于搬運碼垛的任務(wù)已經(jīng)滿足要求，還能簡化后續(xù)碼垛機器人的姿態(tài)控制規(guī)劃過程，提高搬運、碼垛過程的效率，比較適合于重物的連續(xù)快速碼垛。

2 碼垛機器人的運動學(xué)分析

忽略碼垛機器人的某些結(jié)構(gòu)細(xì)節(jié)，繪制出混聯(lián)碼垛機器人的運動結(jié)構(gòu)簡圖，如圖3所示，建立各構(gòu)件的D-H坐標(biāo)系并對機器人進行運動學(xué)位置正解的分析。由于該碼垛機器人是混聯(lián)結(jié)構(gòu)，不能直接獲得其并聯(lián)部分的D-H參數(shù)[5]，因此先分離出其中的2(2-RPR)并聯(lián)機構(gòu)并研究該并聯(lián)機構(gòu)的運動學(xué)位置正解，然后將該并聯(lián)機構(gòu)當(dāng)做一整體去分析，得到混聯(lián)碼垛機器人的D-H參數(shù)表，從而容易求出該機器人末端的位姿。

如圖3所示，上面的一組平行雙聯(lián)同步伸縮電動缸的長度分別是l1和l2，且l1=l2；下面的一組平行雙聯(lián)同步伸縮電動缸的長度分別是l3和l4，且l3=l4，由于該組電動缸安裝形式及運動規(guī)律相同，故后面僅對l3進行分析，其中A1O2=a，A1A2=B1O3=b。另外，腰部回轉(zhuǎn)電機的轉(zhuǎn)動角度為θ1；坐標(biāo)原點O1與鉸鏈點O2之間的垂直距離為H；鉸鏈點O3與交點O4之間的距離為r，回轉(zhuǎn)軸的轉(zhuǎn)動角度為θ2。

圖3 碼垛機器人結(jié)構(gòu)簡圖

取動平臺底部旋轉(zhuǎn)軸上的一點P作為研究對象，研究點P相對于固定坐標(biāo)系O1的位姿。該機器人中的運動部件是腰部回轉(zhuǎn)電機、同步伸縮電動缸以及腕部旋轉(zhuǎn)軸電機，對應(yīng)的主動關(guān)節(jié)變量是θ1,l1(l2),l3(l4)和θ2。

2.1 2(2-2RPR)并聯(lián)結(jié)構(gòu)位置正解

在圖3中，A1點在坐標(biāo)系{O2}中的坐標(biāo)是2A1=[0，0，a]T，A2點在坐標(biāo)系{O2}中的坐標(biāo)是2A2=[0，0，a-b]T；B1點在坐標(biāo)系{O3}中的坐標(biāo)是3B1=[0，0，b]T。假定原點O3在坐標(biāo)系{O2}中的坐標(biāo)是2O3=[x，y，z]T，由于鉸鏈點O2和O3間的l3始終位于坐標(biāo)系{O2}的X2O2Z2平面內(nèi)，因此可知y=0。

B1點在坐標(biāo)系{O2}中可表示為：

2B1=3B1+2O3=[x,0,z+b]T

(1)

可推得電動缸l1,l3的矢量L1，L3：

L1=2B1-2A1=[x,0,z-a+b]T

(2)

L3=[x,0,z]T

(3)

由式(2)、式(3)可得：

(4)

(5)

將式(4)、式(5)兩端平方，可求得x和z，從而得到并聯(lián)部分末端點O3在坐標(biāo)系2中的位置為：

(6)

2.2 混聯(lián)機構(gòu)位置正解

2.1節(jié)已求得并聯(lián)機構(gòu)末端點O3在坐標(biāo)系{O2}中的位置，現(xiàn)將并聯(lián)機構(gòu)視作一整體串聯(lián)進去，利用串聯(lián)機器人分析方法得到整個機器人的D-H參數(shù)，見表1。其中:n表示構(gòu)件編號；an-1表示連桿長度；αn-1表示連桿扭角；dn表示兩連桿距離；θn表示兩連桿轉(zhuǎn)角。

表1 機器人的D-H參數(shù)表

(7)

(8)

(9)

(10)

其中：

在圖3所示的坐標(biāo)系{O4}中，P點關(guān)于θ1，l1，l3，θ2的廣義坐標(biāo)是4P=[0 0 0 1]T，所以P點在坐標(biāo)系{O1}的廣義坐標(biāo)為：

(11)

通過運算，即可求出P點的位置坐標(biāo)與廣義坐標(biāo)之間的關(guān)系如下：

(12)

假定碼垛機器人末端坐標(biāo)系{O4}相對于固定坐標(biāo)系{O1}繞Z1軸的轉(zhuǎn)動角度為α，則

α=θ1+θ2

(13)

由式(12)和式(13)可以看出，該機器人末端旋轉(zhuǎn)軸上點P的位置變化與4個廣義坐標(biāo)變量緊密相關(guān)；而P點的姿態(tài)變化僅有單方向的旋轉(zhuǎn)，故后文暫不考慮其姿態(tài)誤差，僅僅分析影響其位置誤差的主要因素。

3 碼垛機器人的誤差模型

本文重點研究影響該機器人末端位置誤差的主要因素，這里從廣義坐標(biāo)θ1,l1,l3,θ2的偏差大小來分析它們對碼垛機器人末端位置誤差的影響情況。

通常情況下，機器人末端執(zhí)行器的位姿誤差與組成機器人的主動桿件的運動變量偏差存在一定的函數(shù)對應(yīng)關(guān)系，故將對碼垛機器人位姿誤差的研究等同于對其函數(shù)誤差模型的研究。根據(jù)攝動法相關(guān)理論，該混聯(lián)碼垛機器人的末端位姿誤差ΔR可近似用式(14)計算[6]：

(14)

式中：θi為兩連桿轉(zhuǎn)角；di為兩連桿距離；ai為連桿長度；αi為連桿扭角。

根據(jù)式(14)，可求得機器人末端點P因廣義坐標(biāo)θ1，l1，l3，θ2引起的位姿誤差δP為：

δP=[δPxδPyδPzδPα]T=A·[δθ1δl1δl3δθ2]T

(15)

其中：

(16)

根據(jù)式(16)可知，碼垛機器人的姿態(tài)誤差僅與θ1,θ2有關(guān)，且只有繞Z1軸的單方向角度偏轉(zhuǎn)，故不考慮碼垛機器人的姿態(tài)誤差。而機器人的位置誤差與這4個廣義坐標(biāo)(θ1,l1,l3,θ2)都有關(guān)，且這4個廣義坐標(biāo)對P點的位置坐標(biāo)的影響程度不同。

4 碼垛機器人的數(shù)值仿真分析

根據(jù)式(15)所示的碼垛機器人位姿誤差矩陣方程，使用MATLAB軟件對其進行仿真運算，可得到廣義坐標(biāo)(θ1,l1,l3,θ2)偏差大小對該混聯(lián)機器人末端位置誤差的影響情況。

該混聯(lián)機器人的設(shè)計參數(shù)為：a=700 mm，b=350 mm，H=1 000 mm，r=70 mm。該混聯(lián)碼垛機器人移動副l1,l3及轉(zhuǎn)動副θ1與時間t的運動學(xué)方程[10]為：

l1=l2=1 011.43+80sin(0.5t)

(17)

l3=l4=1 041.12+140sin(0.5t)

(18)

(19)

先取動副l1與移動副l3的偏差為0.05 mm，回轉(zhuǎn)副偏差θ1為0.1°；再取定移動副l1與移動副l3偏差為0.10 mm，回轉(zhuǎn)副偏差θ1為0.2°，分別對其進行仿真計算，得到廣義坐標(biāo)偏差引起的末端位置誤差如圖4所示。

圖4 位置誤差圖

現(xiàn)改變各項廣義坐標(biāo)偏差的大小，分析其對P點各個方向位置誤差的影響情況，仿真結(jié)果如圖5所示。

圖5 單向位置誤差對比圖

根據(jù)圖4以及圖5可得，各移動副(l1,l3)和轉(zhuǎn)動副(θ1)偏差對機器人末端位置P點x方向和y方向的位置誤差影響較大，而對z方向的位置誤差影響很??；轉(zhuǎn)動副θ1偏差對機器人末端位置P點x方向和y方向的位置誤差影響較大?？梢钥闯?，該混聯(lián)碼垛機器人末端在z方向的位置誤差很小，基本不受廣義坐標(biāo)偏差的影響，而在x方向和y方向的位置誤差較大，主要受廣義坐標(biāo)θ1偏差的影響。

5 結(jié)束語

本文首先針對碼垛機器人的工作需求和工作空間，綜合考慮串聯(lián)機構(gòu)與并聯(lián)機構(gòu)的優(yōu)缺點，設(shè)計一款新型混聯(lián)碼垛機器人。該機器人不僅承載能力大、運動累積誤差小，而且運動空間大、運動規(guī)律易于掌控。通過分析該機器人廣義坐標(biāo)偏差對機器人末端位姿誤差的影響情況，可以發(fā)現(xiàn)該機器人的位姿誤差較小，符合碼垛機器人的技術(shù)要求。