一、引言：
隨著工業(yè)技術(shù)的發(fā)展，工業(yè)機械手的功能和種類越來越豐富，其中并聯(lián)機械手也得到了廣泛的應(yīng)用，特別是在物料分揀這類重復(fù)性高，強度大的功能上，與傳統(tǒng)的串聯(lián)機械手相比，成本低，性能高。本文主要介紹了并聯(lián)機械手結(jié)構(gòu)，正運動總線控制器在三軸并聯(lián)機械手的應(yīng)用以及控制過程的實現(xiàn)。
二、并聯(lián)機械手簡介
1.1結(jié)構(gòu)組成及特點
傳統(tǒng)的機械手結(jié)構(gòu)末端執(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)結(jié)構(gòu)那樣誤差累計。
3.運動平穩(wěn)，主要部件都連接在基座，質(zhì)心靠近不同的基座，所以運動慣量低。
4.成本低，結(jié)構(gòu)基本都是標(biāo)準(zhǔn)件。
1.2基本參數(shù)
并聯(lián)機械手結(jié)構(gòu)的基本參數(shù)定義如下圖。
圖 3并聯(lián)機械手基本參數(shù)
R:大臂旋轉(zhuǎn)中心到基座中心的距離。
L1：大臂長度，兩端旋轉(zhuǎn)中心距離。
L2：小臂長度，兩端旋轉(zhuǎn)中心距離。
r：小臂末端連接中心到底座中心的距離。
LX:末端工作點相對于底座中心的X偏移，（負(fù)向為負(fù)數(shù)）
LY: 末端工作點相對于底座中心的Y偏移，（負(fù)向為負(fù)數(shù)）
LZ: 末端工作點相對于底座中心的Z偏移，（負(fù)向為負(fù)數(shù)）
1.3主要應(yīng)用
并聯(lián)機械手目前主要應(yīng)用在零件檢測和物料分揀上，其結(jié)構(gòu)特點使得運行時速度可以更快，提高生產(chǎn)效率。根據(jù)傳感器和控制程序的設(shè)置可以實現(xiàn)不同的功能,比如現(xiàn)在出現(xiàn)的三軸并聯(lián)機械手結(jié)構(gòu)的3d打印機。
三、EtherCAT簡介
EtherCAT（以太網(wǎng)控制自動化技術(shù)）是一個以以太網(wǎng)為基礎(chǔ)的開放架構(gòu)的現(xiàn)場總線系統(tǒng)，EtherCAT名稱中的CAT為Control Automation Technology（控制自動化技術(shù)）首字母的縮寫。開始由德國倍福自動化有限公司(Beckhoff Automation GmbH) 研發(fā)。
EtherCAT在網(wǎng)絡(luò)性能上達(dá)到了一個新的高度。1000個分布式I/O數(shù)據(jù)的刷新周期僅為30μs，其中包括端子循環(huán)時間。通過一個以太網(wǎng)幀，可以交換高達(dá)1486字節(jié)的過程數(shù)據(jù)，幾乎相當(dāng)于12000個數(shù)字量I/O。而這一數(shù)據(jù)量的傳輸僅用300μs。
與100個伺服軸的通訊只需100μs。在此期間，可以向所有軸提供設(shè)置值和控制數(shù)據(jù)，并報告它們的實際位置和狀態(tài)。分布式時鐘技術(shù)保證了這些軸之間的同步時間偏差小于1微秒。
利用 EtherCAT 技術(shù)的優(yōu)異性能，可以實現(xiàn)用傳統(tǒng)現(xiàn)場總線系統(tǒng)所無法實現(xiàn)的控制方法。這樣，通過總線也可以形成超高速控制回路。以前需要本地專用硬件支持的功能現(xiàn)在可在軟件中加以映射。巨大的帶寬資源使?fàn)顟B(tài)數(shù)據(jù)與任何數(shù)據(jù)可并行傳輸。EtherCAT技術(shù)使得通訊技術(shù)與現(xiàn)代高性能的工業(yè)PC相匹配。總線系統(tǒng)不再是控制理念的瓶頸。分布式I/O的數(shù)據(jù)傳遞超過了只能由本地I/O接口才能實現(xiàn)的性能。
四、正運動EtherCAT總線控制器
正運動技術(shù)有限公司致力于做更好的運動控制器，非總線的ZMC運動控制器采用華為 IPD-CMM 軟件開發(fā)流程開發(fā)，使得產(chǎn)品具備電信級的穩(wěn)定性；結(jié)合了新的控制理論及網(wǎng)絡(luò)控制技術(shù)； 以太網(wǎng),RS232,RS485, USB,CAN 等多種接口；單控制器最多可以控制多達(dá) 32 個軸。同時結(jié)合了傳統(tǒng)PLC和運動控制卡，即可進行邏輯控制，又可進行運動控制，精簡了工業(yè)現(xiàn)場的控制設(shè)備。
而在發(fā)現(xiàn)了市場上對于EtherCAT總線控制器的需求后，正運動技術(shù)有限公司更進一步，潛心開發(fā)出了EtherCAT總線運動控制器、總線IO擴展和總線軸擴展等一系列產(chǎn)品。本次就采用ZMC464總線控制器對3軸并聯(lián)機械手進行控制，外觀如下圖。
圖 4 ZMC464總線控制器
ZMC464在非總線運動控制器的基礎(chǔ)上，優(yōu)化了以下幾點。
最多達(dá) 64 軸運動控制(3 脈沖軸+64ECAT 軸)；
支持最多達(dá) 16 軸同時直線插補、 任意空間圓弧插補、 螺旋插補 ；
支持多機臺同時聯(lián)動；
ECAT 最快 100us 的刷新周期；
每軸最大輸出脈沖頻率 8MHz；
EtherCAT總線控制器的出現(xiàn)，使得運動控制的響應(yīng)速度更快，精度更高。現(xiàn)場接線更加簡潔、簡單，驅(qū)動器不再需要一一與控制器上的軸接口一一對應(yīng)，只需要用網(wǎng)線串接驅(qū)動器即可，現(xiàn)場控制電箱體積更小。
五、正運動控制方案
本方案使用的3軸并聯(lián)機械手如下圖5，基本參數(shù)如圖6。
圖 5使用的三軸并聯(lián)機械手 圖6機械手基本參數(shù)
對于并聯(lián)機械手的控制而言，關(guān)鍵的是如何將關(guān)節(jié)軸坐標(biāo)系轉(zhuǎn)換為笛卡爾坐標(biāo)系，操作末端執(zhí)行器在笛卡爾坐標(biāo)系中運動，關(guān)節(jié)軸要能夠自動解算出響應(yīng)的關(guān)節(jié)軸坐標(biāo)，這個過程就是逆解，需要編寫相應(yīng)的算法。
為了更方便的使用，正運動已經(jīng)將不同的機械結(jié)構(gòu)算法進行了封裝，使用的時候只需要設(shè)置好然機械結(jié)構(gòu)的參數(shù)，然后使用CONNframe指令調(diào)用3軸并聯(lián)機械手結(jié)構(gòu)即可。建立連接后，我們就可以通過操作3個虛擬軸使末端執(zhí)行器移動到笛卡爾坐標(biāo)系中的指定位置，此時3個關(guān)節(jié)軸會自動解算需要旋轉(zhuǎn)的角度。
本方案主要實現(xiàn)直線運動和圓弧運動。
1.控制器接線
使用網(wǎng)線通過EtheaCAT接口將ZMC464與伺服驅(qū)動器連接，驅(qū)動器要支持EtherCAT總線驅(qū)動，這里使用的是邁信EP3驅(qū)動器。連接好第一個驅(qū)動器后，用網(wǎng)線依次串接剩余驅(qū)動器即可，如下圖。
圖 7 ZMC464總線控制器接線
2.控制器設(shè)置
ZMC總線控制器通過axis_address指令可以設(shè)置驅(qū)動器綁定的軸號。通過atype()指令可以設(shè)置軸的控制類型。本方案采用atype=65位置閉環(huán)模式控制機械手。
可以通過DRIVER類型指令直接對驅(qū)動器設(shè)置，比如drive_mode可以設(shè)置驅(qū)動器的控制模式（對應(yīng)驅(qū)動器數(shù)據(jù)字典）。DRIVE_CONTROLWORD設(shè)置驅(qū)動功能。
也可以通過SDO_READ和SDO_WRITE直接對驅(qū)動器進行讀寫。
3.控制程序
過程控制的程序可以通過Zdevelop編寫，使用了Zbasic編程環(huán)境。根據(jù)需要的功能，可以自定義編寫相應(yīng)功能的SUB，使程序結(jié)構(gòu)更清晰易讀。本方案包含的功能主要有機械手結(jié)構(gòu)正解逆解的切換、相對絕對模式的切換、G代碼操作、手動操作等。
運動時的實時參數(shù)也可通過zdevelop的軸參數(shù)查看。
圖 8軸參數(shù)列表
3.HMI人機界面
正運動開發(fā)了自己的HMI人機界面和手持盒，并加入到ZDevelop編程軟件中，與basic聯(lián)合編程，使得在basic編程的同時也可以進行HMI界面設(shè)計，程序?qū)⒁煌螺d到控制器。通過網(wǎng)線連接控制器與手持盒，會自動顯示出hmi界面。
圖 9 HMI界面
4.機械手運動方式
程序中建立了與標(biāo)準(zhǔn)G代碼功能相同的自定義G代碼，如下圖。
圖 10 G代碼
操作者可以直接使用G代碼來編寫運動程序，控制3軸機械手的運動軌跡，實現(xiàn)了脫離PC端編程。本方案中主要使用了G01直線運動和G02順圓指令，在笛卡爾坐標(biāo)系中運動軌跡為，原點位置(0,0,-294)->(0,0,-450)->(180,0,-450)->(180,0,-450)->順時針畫整圓->回原點(0,0,-294)。
5.控制器報警
總線控制器連接好驅(qū)動器后，要通過寫指令使驅(qū)動器使能并綁定軸號，如果編寫軸指令數(shù)量與連接的驅(qū)動器數(shù)量不一致時，驅(qū)動器不會使能，預(yù)防因漏接多接可能引起的事故。同時，在運行過程中，如果斷開某一驅(qū)動器，運動會立即停止并報警；如果連接新的驅(qū)動器，不會對新連接的驅(qū)動器操作，直到斷電重啟并修改程序。
可以在命令行輸入?*ethercat，來查看驅(qū)動器狀態(tài)。
圖 11 驅(qū)動器狀態(tài)
六、結(jié)論
通過一段時間的測試，使機械手在不同的速度下運行時都能保持平穩(wěn)準(zhǔn)確。綜上所述，ZMC總線控制器通過basic編寫過程程序，通過HMI組態(tài)環(huán)境編寫人機界面，二者結(jié)合，更加方便了多軸運動控制的實現(xiàn)，而且總線控制器響應(yīng)速度快，接線簡單方便，在多軸聯(lián)動控制方面更具優(yōu)勢。
七、附錄：運動軌跡截圖
原點位置
直線軌跡
整圓軌跡
作者簡介
謝江文(1994-) 男 現(xiàn)就職于深圳正運動技術(shù)有限公司 技術(shù)工程師
地址 深圳市寶安區(qū)西鄉(xiāng)鐘屋1路70號大廣發(fā)綜合樓5樓
