一種四自由度碼垛機(jī)器人機(jī)構(gòu)和運(yùn)動(dòng)分析

1 前言

　　隨著物流、食品和石化等行業(yè)的不斷發(fā)展，碼垛機(jī)器人發(fā)揮著越來(lái)越重要的作用，它不僅可以準(zhǔn)確、高效地完成碼垛作業(yè)，而且可以降低工人的勞動(dòng)強(qiáng)度，提高生產(chǎn)效率。

　　目前，國(guó)外主要機(jī)器人廠家，如ABB、FANUC等，均有較為完善的碼垛機(jī)器人產(chǎn)品系列，壟斷了國(guó)內(nèi)外市場(chǎng)；而國(guó)內(nèi)，碼垛機(jī)器人的研究起步不久，還未有成熟的，產(chǎn)業(yè)化的碼垛機(jī)器人產(chǎn)品出現(xiàn)。本文研究了ER300碼垛機(jī)器人結(jié)構(gòu)特點(diǎn)及運(yùn)動(dòng)空間，展現(xiàn)了一般碼垛機(jī)器人與六自由度機(jī)器人的結(jié)構(gòu)差異和運(yùn)動(dòng)空間形成方式。

　　2 碼垛機(jī)器人機(jī)構(gòu)分析

　　基于碼垛任務(wù)的實(shí)際需要，碼垛機(jī)器人通常具有四自由度。與一般垂直型六自由度串聯(lián)工業(yè)機(jī)器人的結(jié)構(gòu)不同，碼垛機(jī)器人通過(guò)在肩部串聯(lián)兩個(gè)平行四邊形結(jié)構(gòu)使得腕關(guān)節(jié)旋轉(zhuǎn)軸始終與地面垂直，從而使被抓持物始終處于水平狀態(tài)；腕部結(jié)構(gòu)簡(jiǎn)單，沒(méi)有復(fù)雜的姿態(tài)調(diào)整結(jié)構(gòu)。目前，碼垛機(jī)器人使用較為廣泛的結(jié)構(gòu)之一，如圖1所示：

　　將圖1中三維模型進(jìn)一步簡(jiǎn)化為桿件連接（略去了1軸和平衡缸），如圖2所示，A點(diǎn)為機(jī)器人2軸，B點(diǎn)為復(fù)合鉸鏈，通過(guò)三角架分別與大臂和大臂副桿，與小臂和小臂副桿組成串聯(lián)的平行四邊形結(jié)構(gòu)，使得運(yùn)動(dòng)過(guò)程中手腕體回轉(zhuǎn)軸始終與地面保持垂直，從而手腕體中心D點(diǎn)相對(duì)小臂末端C點(diǎn)位置也保持不變。

　　此外，ER300機(jī)器人采用了將3軸電機(jī)和減速器均固定在三角架上的安裝方式。該種連接方式使得三角架和大臂副桿承受了小臂、手腕體和負(fù)載等組件關(guān)于3軸的轉(zhuǎn)矩M,但小臂不與大臂耦合旋轉(zhuǎn)，在很大程度上簡(jiǎn)化機(jī)器人的運(yùn)動(dòng)方式和控制方法。

　　鑒于ER300碼垛機(jī)器人沒(méi)有復(fù)雜的耦合運(yùn)動(dòng)，本文不采用傳統(tǒng)的D-H方法進(jìn)行計(jì)算。為研究計(jì)算D點(diǎn)運(yùn)動(dòng)可達(dá)空間，這里將全局坐標(biāo)系原點(diǎn)O0固定在1軸與地面的交點(diǎn)處，Y0與1軸重合，其余局部坐標(biāo)系如圖2所示

　　在全局坐標(biāo)系中，各關(guān)節(jié)點(diǎn)坐標(biāo)與關(guān)節(jié)旋轉(zhuǎn)角之間的換算關(guān)系如下：

　　其中，R、H分別為1軸回轉(zhuǎn)半徑和底座高度；L2、L3分別為大臂和小臂長(zhǎng)度；、分別為大臂相對(duì)Y1軸旋轉(zhuǎn)角度，小臂相對(duì)X2軸旋轉(zhuǎn)角度，本文規(guī)定逆時(shí)針旋轉(zhuǎn)為正向；S為長(zhǎng)。

　　零位時(shí)，2軸和3軸的旋轉(zhuǎn)范圍分別，.為保護(hù)碼垛機(jī)器人末端平行四邊形結(jié)構(gòu)，防止桿件間發(fā)生干涉，ER300為小臂與三角架之間設(shè)定的安全角度為（如圖3所示）。因此，小臂旋轉(zhuǎn)角范圍與大臂旋轉(zhuǎn)角函數(shù)關(guān)系為：

　　圖3展現(xiàn)了在2軸兩個(gè)極限位置時(shí)，小臂與三角架之間的最大和最小的安全角度。