一、引言

隨著工業(yè)技術的發(fā)展，工業(yè)機械手的功能和種類越來越豐富，其中并聯(lián)機械手也得到了廣泛的應用，特別是在物料分揀這類重復性高，強度大的功能上，與傳統(tǒng)的串聯(lián)機械手相比，成本低，性能高。本文主要介紹了并聯(lián)機械手結構，正運動總線控制器在三軸并聯(lián)機械手的應用以及控制過程的實現(xiàn)。

二、并聯(lián)機械手簡介

1.1結構組成及特點

傳統(tǒng)的機械手結構末端執(zhí)行器與基座之間只有一條運動鏈，我們稱為串聯(lián)機械手，而并聯(lián)機械手末端執(zhí)行器至少有兩條運動鏈與基座相連。根據(jù)運動鏈的條數(shù)n不同，把并聯(lián)機械手稱為n軸并聯(lián)機械手，常見的一般為3軸機械手或4軸機械手。

圖1三軸機械手                圖2四軸機械手

與串聯(lián)機械手相比，并聯(lián)機械手具備以下幾個優(yōu)勢：

1.剛度大，多條運動鏈可以分享載荷。

2.精度高，誤差由多條運動鏈均分，不會像串聯(lián)結構那樣誤差累計。

3.運動平穩(wěn)，主要部件都連接在基座，質心靠近不同的基座，所以運動慣量低。

4.成本低，結構基本都是標準件。

1.2基本參數(shù)

并聯(lián)機械手結構的基本參數(shù)定義如下圖。

圖3并聯(lián)機械手基本參數(shù)

R:大臂旋轉中心到基座中心的距離。

L1：大臂長度，兩端旋轉中心距離。

L2：小臂長度，兩端旋轉中心距離。

r：小臂末端連接中心到底座中心的距離。

LX:末端工作點相對于底座中心的X偏移，（負向為負數(shù)）。

LY:末端工作點相對于底座中心的Y偏移，（負向為負數(shù)）。

LZ:末端工作點相對于底座中心的Z偏移，（負向為負數(shù)）。

1.3主要應用

并聯(lián)機械手目前主要應用在零件檢測和物料分揀上，其結構特點使得運行時速度可以更快，提高生產(chǎn)效率。根據(jù)傳感器和控制程序的設置可以實現(xiàn)不同的功能,比如現(xiàn)在出現(xiàn)的三軸并聯(lián)機械手結構的3d打印機。

三、EtherCAT簡介

EtherCAT（以太網(wǎng)控制自動化技術）是一個以以太網(wǎng)為基礎的開放架構的現(xiàn)場總線系統(tǒng)，EtherCAT名稱中的CAT為ControlAutomationTechnology（控制自動化技術）首字母的縮寫。最初由德國倍福自動化有限公司(BeckhoffAutomationGmbH)研發(fā)。

EtherCAT在網(wǎng)絡性能上達到了一個新的高度。1000個分布式I/O數(shù)據(jù)的刷新周期僅為30μs，其中包括端子循環(huán)時間。通過一個以太網(wǎng)幀，可以交換高達1486字節(jié)的過程數(shù)據(jù)，幾乎相當于12000個數(shù)字量I/O。而這一數(shù)據(jù)量的傳輸僅用300μs。

與100個伺服軸的通訊只需100μs。在此期間，可以向所有軸提供設置值和控制數(shù)據(jù)，并報告它們的實際位置和狀態(tài)。分布式時鐘技術保證了這些軸之間的同步時間偏差小于1微秒。

利用EtherCAT技術的優(yōu)異性能，可以實現(xiàn)用傳統(tǒng)現(xiàn)場總線系統(tǒng)所無法實現(xiàn)的控制方法。這樣，通過總線也可以形成超高速控制回路。以前需要本地專用硬件支持的功能現(xiàn)在可在軟件中加以映射。巨大的帶寬資源使狀態(tài)數(shù)據(jù)與任何數(shù)據(jù)可并行傳輸。EtherCAT技術使得通訊技術與現(xiàn)代高性能的工業(yè)PC相匹配?？偩€系統(tǒng)不再是控制理念的瓶頸。分布式I/O的數(shù)據(jù)傳遞超過了只能由本地I/O接口才能實現(xiàn)的性能。

四、正運動EtherCAT總線控制器

正運動技術有限公司致力于做更好的運動控制器，非總線的ZMC運動控制器采用華為IPD-CMM軟件開發(fā)流程開發(fā)，使得產(chǎn)品具備電信級的穩(wěn)定性；結合了最新的控制理論及網(wǎng)絡控制技術；以太網(wǎng),RS232,RS485,USB,CAN等多種接口；單控制器最多可以控制多達32個軸。同時結合了傳統(tǒng)PLC和運動控制卡，即可進行邏輯控制，又可進行運動控制，精簡了工業(yè)現(xiàn)場的控制設備。

而在發(fā)現(xiàn)了市場上對于EtherCAT總線控制器的需求后，正運動技術有限公司更進一步，潛心開發(fā)出了EtherCAT總線運動控制器、總線IO擴展和總線軸擴展等一系列產(chǎn)品。本次就采用ZMC464總線控制器對3軸并聯(lián)機械手進行控制，外觀如下圖。

圖4 ZMC464總線控制器

ZMC464在非總線運動控制器的基礎上，優(yōu)化了以下幾點。

最多達64軸運動控制(3脈沖軸+64ECAT軸)；

支持最多達16軸同時直線插補、任意空間圓弧插補、螺旋插補；

支持多機臺同時聯(lián)動；

ECAT最快100us的刷新周期；

每軸最大輸出脈沖頻率8MHz；

EtherCAT總線控制器的出現(xiàn)，使得運動控制的響應速度更快，精度更高?，F(xiàn)場接線更加簡潔、簡單，驅動器不再需要一一與控制器上的軸接口一一對應，只需要用網(wǎng)線串接驅動器即可，現(xiàn)場控制電箱體積更小。

五、正運動控制方案

本方案使用的3軸并聯(lián)機械手如下圖5，基本參數(shù)如圖6。

圖5使用的三軸并聯(lián)機械手                                       圖6機械手基本參數(shù)

對于并聯(lián)機械手的控制而言，最為關鍵的是如何將關節(jié)軸坐標系轉換為笛卡爾坐標系，操作末端執(zhí)行器在笛卡爾坐標系中運動，關節(jié)軸要能夠自動解算出響應的關節(jié)軸坐標，這個過程就是逆解，需要編寫相應的算法。

為了更方便的使用，正運動已經(jīng)將不同的機械結構算法進行了封裝，使用的時候只需要設置好然機械結構的參數(shù)，然后使用CONNFRAME指令調(diào)用3軸并聯(lián)機械手結構即可。建立連接后，我們就可以通過操作3個虛擬軸使末端執(zhí)行器移動到笛卡爾坐標系中的指定位置，此時3個關節(jié)軸會自動解算需要旋轉的角度。

本方案主要實現(xiàn)直線運動和圓弧運動。

1.控制器接線

使用網(wǎng)線通過EtheaCAT接口將ZMC464與伺服驅動器連接，驅動器要支持EtherCAT總線驅動，這里使用的是邁信EP3驅動器。連接好第一個驅動器后，用網(wǎng)線依次串接剩余驅動器即可，如下圖。

圖7 ZMC464總線控制器接線

2.控制器設置

ZMC總線控制器通過axis_address指令可以設置驅動器綁定的軸號。通過atype()指令可以設置軸的控制類型。本方案采用atype=65位置閉環(huán)模式控制機械手。

可以通過DRIVER類型指令直接對驅動器設置，比如drive_mode可以設置驅動器的控制模式（對應驅動器數(shù)據(jù)字典）。DRIVE_CONTROLWORD設置驅動功能。

也可以通過SDO_READ和SDO_WRITE直接對驅動器進行讀寫。

3.控制程序

過程控制的程序可以通過Zdevelop編寫，使用了Zbasic編程環(huán)境。根據(jù)需要的功能，可以自定義編寫相應功能的SUB，使程序結構更清晰易讀。本方案包含的功能主要有機械手結構正解逆解的切換、相對絕對模式的切換、G代碼操作、手動操作等。

運動時的實時參數(shù)也可通過zdevelop的軸參數(shù)查看。

圖8 軸參數(shù)列表

3.HMI人機界面

正運動開發(fā)了自己的HMI人機界面和手持盒，并加入到ZDevelop編程軟件中，與basic聯(lián)合編程，使得在basic編程的同時也可以進行HMI界面設計，程序將一同下載到控制器。通過網(wǎng)線連接控制器與手持盒，會自動顯示出hmi界面。

圖9 HMI界面

4.機械手運動方式

程序中建立了與標準G代碼功能相同的自定義G代碼，如下圖。

圖10 G代碼

操作者可以直接使用G代碼來編寫運動程序，控制3軸機械手的運動軌跡，實現(xiàn)了脫離PC端編程。本方案中主要使用了G01直線運動和G02順圓指令，在笛卡爾坐標系中運動軌跡為，原點位置(0,0,-294)->(0,0,-450)->(180,0,-450)->(180,0,-450)->順時針畫整圓->回原點(0,0,-294)。

5.控制器報警

總線控制器連接好驅動器后，要通過寫指令使驅動器使能并綁定軸號，如果編寫軸指令數(shù)量與連接的驅動器數(shù)量不一致時，驅動器不會使能，預防因漏接多接可能引起的事故。同時，在運行過程中，如果斷開某一驅動器，運動會立即停止并報警；如果連接新的驅動器，不會對新連接的驅動器操作，直到斷電重啟并修改程序。

可以在命令行輸入?*ethercat，來查看驅動器狀態(tài)。

圖11 驅動器狀態(tài)

六、結論

通過一段時間的測試，使機械手在不同的速度下運行時都能保持平穩(wěn)準確。綜上所述，ZMC總線控制器通過basic編寫過程程序，通過HMI組態(tài)環(huán)境編寫人機界面，二者結合，更加方便了多軸運動控制的實現(xiàn)，而且總線控制器響應速度快，接線簡單方便，在多軸聯(lián)動控制方面更具優(yōu)勢。

更多資訊請關注工業(yè)機器人頻道