李琰，劉歡慶，高建設(shè)，蘇宇鋒

(鄭州大學(xué)機械與動力工程學(xué)院，河南鄭州 450000)

0 前言

在電芯涂膠工作單元中需要用到6R機器人，而實現(xiàn)機器人任務(wù)作業(yè)必然離不開機器人的編程技術(shù)，示教是工業(yè)機器人作業(yè)任務(wù)的首要前提。工業(yè)機器人的示教技術(shù)主要包括：在線示教和離線示教兩種工作方式[1]。目前，工業(yè)機器人的作業(yè)任務(wù)程序主要靠在線示教編程來實現(xiàn)。在線示教需要機器人停機編程，影響生產(chǎn)，而且依靠操作員目視采點精度不高，操作人員在惡劣環(huán)境進行在線編程時，其人身安全得不到保證[2-3]。機器人的離線示教方式解決了面對復(fù)雜任務(wù)編程時傳統(tǒng)的在線示教效率低、精度差和安全性等問題。因此離線示教在工業(yè)生產(chǎn)過程中得到了廣泛的應(yīng)用[4]。離線示教編程是通過建立機器人和周圍環(huán)境的三維模型，并對該模型進行控制和變換，使機器人模型按照相應(yīng)的作業(yè)軌跡進行運動并生成作業(yè)程序控制物理機器人運動[5]，可以有效規(guī)避手動在線示教的上述缺點。基于此，國內(nèi)外對于機器人離線編程都進行了一定研究，如日本的安川公司研發(fā)的離線編程軟件MotoSimEG，可以在虛擬空間中模擬機器人作業(yè)環(huán)境，進行作業(yè)任務(wù)仿真并生成程序，然后傳輸?shù)綑C器人控制柜中[6]。德國庫卡公司研發(fā)的離線編程軟件KUKASim也具有相似功能[7]。但這些軟件不開源，只能用于所屬公司的機器人。國內(nèi)有上海交通大學(xué)機器人研究所的曾建軍、楊汝清等開發(fā)的排爆機器人離線編程系統(tǒng)，可搭建機器人和爆炸物的虛擬環(huán)境，來增強操作者感知排爆物的能力[8]；沈陽航空航天大學(xué)的屈力剛、李見等人開發(fā)的基于CATIA的機器人離線編程系統(tǒng)，可以快速方便地進行機器人離線作業(yè)，并按照預(yù)先規(guī)劃的軌跡快速、高精度地完成飛機進氣道噴涂[9]。

機器人離線編程系統(tǒng)具有廣闊的應(yīng)用前景，且國內(nèi)在該技術(shù)上大多仍處于實驗室階段，因此現(xiàn)階段的研究具有很大應(yīng)用意義[10]。為了實現(xiàn)高質(zhì)量、高效率自動化生產(chǎn)，本文作者以六自由度的KUKA KR16機器人涂膠電芯為研究實例，研究了6R工業(yè)機器人的多種任務(wù)規(guī)劃方式，還將離線示教編程與自動編程進行了結(jié)合。離線自動編程不僅使涂膠作業(yè)精度和加工質(zhì)量得以提高，而且還提高了生產(chǎn)效率。

1 虛擬工作環(huán)境建模

文中工業(yè)機器人的三維模型是通過SolidWorks三維建模軟件構(gòu)建的。為實現(xiàn)整個機器人的可視化模型運動，首先將機器人的關(guān)節(jié)模型保存為STL的數(shù)據(jù)文件，利用MATLAB中的read STL算法讀取機器人關(guān)節(jié)模型的數(shù)據(jù)文件，先讀取基座的數(shù)據(jù)文件，顯示結(jié)果如圖1中的{WORLD}所示，接著讀取連桿1，此時{WORLD}坐標(biāo)系與{1}坐標(biāo)系重合，因此需要對連桿1平移和旋轉(zhuǎn)，將連桿1調(diào)整為圖中所示。按照連桿1可視化的流程，從而能夠?qū)崿F(xiàn)整個機器人的可視化。

圖1 工業(yè)6R機器人虛擬可視化流程Fig.1 Virtual visualization process for industrial 6R robot

實現(xiàn)了虛擬機器人場景模型的建立以后，還需要在MATLAB軟件的框架下實現(xiàn)機器人的運動控制，以便實現(xiàn)對機器人相應(yīng)的操作和設(shè)置。

文中的機器人運動模型是根據(jù)D-H參數(shù)法建立，表1為包含關(guān)節(jié)旋轉(zhuǎn)范圍的D-H參數(shù)[11]。

表1 KR16-2 D-H參數(shù)Tab.1 KR16-2 D-H parameters

機器人的正運動由表1中的αi、ai、θi、di經(jīng)過齊次坐標(biāo)變換可得末端工具坐標(biāo)系的位姿，末端執(zhí)行器相對于基坐標(biāo)系的總變換為

0T6=0T1·1T2·2T3·3T4·4T5·5T6=

(1)

機器人的正解是根據(jù)機器人關(guān)節(jié)角度計算工具的位姿，而機器人運動學(xué)逆解則是根據(jù)工具的位姿計算機器人的關(guān)節(jié)角度。接下來分析機器人解析式求解的過程。

(2)

由等式兩邊二行四列元素相等得-pxsinθ1+pycosθ1=0，變換得tanθ1=py/px→θ1=arctan(py/px)。同理經(jīng)過矩陣變換可求得其他角度。最終確定θ1～θ6的解析表達式。解的排列組合共有8組，而這組解中一定有一個各關(guān)節(jié)轉(zhuǎn)動角度最小的解，即一個“最短行程”的最優(yōu)解。KR16機器人有個大連桿，附帶個小連桿，在確定“最短行程”解時使用加權(quán)系數(shù)，使選擇側(cè)重于移動小連桿而不是大連桿。在存在障礙的情況下，為了避免碰撞，這時可以選擇一個次優(yōu)解[12]。

2 離線手動編程和自動編程的實現(xiàn)

2.1 機器人控制指令解析和創(chuàng)建

通過在虛擬場景下操作虛擬機器人生成虛擬作業(yè)程序，再對虛擬作業(yè)程序進行解析，從而控制虛擬空間中的機器人進行作業(yè)任務(wù)。當(dāng)然，結(jié)合物理機器人運動控制器而編寫的虛擬指令也能夠有效控制物理機器人進行作業(yè)任務(wù)運動。

所研究的工業(yè)機器人采用的編程語言是庫卡機器人編程語言(KUKA Robot Language，KRL)，機器人的控制指令主要包括4大部分：程序的定義、程序的初始化、運動控制指令和結(jié)束標(biāo)記符。

執(zhí)行部分主要是運動控制指令。機器人的運動控制指令是由SRC 格式的程序文件和 DAT格式的數(shù)據(jù)文件共同組成。SRC程序文件中包括機器人控制指令、變量的使用、函數(shù)的調(diào)用等程序語句，SRC文件中所使用的變量定義和賦值都是在DAT數(shù)據(jù)文件中完成的。DAT數(shù)據(jù)部分是根據(jù)虛擬工作空間中機器人各關(guān)節(jié)的角度，由前述機器人運動學(xué)方程求解機器人末端執(zhí)行器的位姿數(shù)據(jù)，然后由此替換程序中各點處的參數(shù)即可。

機器人指令解析和生成流程如圖2所示。

圖2 機器人指令解析和生成流程Fig.2 Robot instruction parsing and generation process

2.2 離線示教編程的任務(wù)規(guī)劃

通過開發(fā)六自由度機器人的離線示教界面，使用戶通過示教界面實現(xiàn)對KUKA KR16型工業(yè)機器人的運動控制，有效提高工業(yè)機器人的編程效率，保證示教過程中的安全性。為了使得示教界面具有良好的交互性和實時性，采用了MATLAB GUI建立了機器人虛擬場景和編程界面。所開發(fā)的示教界面如圖3所示。

圖3 離線示教界面Fig.3 Offline teaching interface

離線示教界面具有物理示教器的基本功能，整個示教界面主要由關(guān)節(jié)空間操作面板、笛卡爾空間操作面板、顯示面板和程序面板組成。關(guān)節(jié)空間面板和笛卡爾空間面板主要負(fù)責(zé)對工業(yè)機器人示教運動控制，該面板是實現(xiàn)手動離線編程的重要前提。顯示面板用來顯示機器人當(dāng)前狀態(tài)下的位姿數(shù)據(jù)，該數(shù)據(jù)采用了兩個表達方式：齊次變換矩陣和四元數(shù)。程序面板主要用來實現(xiàn)機器人控制程序的編輯，將控制程序保存為物理環(huán)境中機器人的可執(zhí)行文件。除了機器人離線示教界面外，還需要整個機器人離線示教的底層核心算法，運動控制算法包括虛擬場景的顯示、虛擬場景中三維模型的運動控制、軌跡規(guī)劃插補算法以及示教程序的編譯解析等。其中軌跡規(guī)劃和運動控制是進行機器人作業(yè)任務(wù)的基礎(chǔ)，程序編譯器的構(gòu)造為運行可執(zhí)行程序奠定了基礎(chǔ)[13]。

涂膠機器人手動離線示教的過程為：首先，拖動滑塊將膠槍拖到作業(yè)任務(wù)點，在程序面板中編輯作業(yè)程序；然后，調(diào)用運動學(xué)正逆解、路徑規(guī)劃算法將位姿信息轉(zhuǎn)化為各個關(guān)節(jié)角度信息，從而能夠?qū)⒆鳂I(yè)程序生成為可執(zhí)行程序。最終離線示教的過程如圖4所示。

2.3 離線自動編程的任務(wù)規(guī)劃

在離線示教的作業(yè)任務(wù)規(guī)劃中要從二維平面采集三維空間中的點，由于視角的原因，有一些點位信息采集不準(zhǔn)，為此本文作者研究基于離線自動編程的任務(wù)規(guī)劃。

首先在電芯表面建立工件坐標(biāo)系，如圖5所示。然后，求取參考坐標(biāo)系相對于基坐標(biāo)系的變換矩陣。不妨設(shè)參考坐標(biāo)系{p}繞X軸的轉(zhuǎn)動角度為θ，此時坐標(biāo)系{p}相對于基坐標(biāo)系的姿態(tài)為

(3)

接著調(diào)節(jié)虛擬示教界面上的滑塊，使得末端執(zhí)行器與參考坐標(biāo)系{p}重合，讀取此時虛擬示教界面上機器人的位置坐標(biāo)(xp,yp,zp)， 最后，在參考坐標(biāo)系{p}下，對電芯的表面規(guī)劃涂膠軌跡。假設(shè)電芯表面的上某一任務(wù)點坐標(biāo)為p1(xp1,yp1,zp1)，則這一任務(wù)點在基坐標(biāo)系下的位置坐標(biāo)為

(4)

建立好參考坐標(biāo)系，然后設(shè)定電芯的尺寸和涂膠軌跡的參數(shù)，可以自動生成前述工業(yè)機器人運動控制指令格式的可執(zhí)行程序，即可控制KR16機器人按預(yù)設(shè)軌跡完成作業(yè)。

圖5 參考坐標(biāo)系示意Fig.5 Diagram of the reference coordinate system

3 虛擬程序?qū)C器人的控制

離線仿真的最終目的是為了控制真實物理環(huán)境中的機器人，而控制程序的創(chuàng)建是實現(xiàn)機器人離線仿真系統(tǒng)應(yīng)用于作業(yè)任務(wù)中的關(guān)鍵?？刂瞥绦虻膭?chuàng)建使虛擬場景中的機器人與物理場景中的機器人能夠有效地聯(lián)系在一起。

采用KUKA KR16六自由度工業(yè)機器人，在機器人末端法蘭盤上安裝膠槍。

根據(jù)涂膠任務(wù)，預(yù)先設(shè)計相應(yīng)的編程軌跡，通過離線示教和自動編程相結(jié)合的方式生成虛擬指令程序。此時的編程的原則為：對于要求精度不高的任務(wù)點使用離線示教編程，精度高的任務(wù)點使用自動編程，既保證了編程速度也提高了加工作業(yè)精度。仿真過程如圖6所示。

圖6 仿真畫面

將虛擬指令下載達到機器人控制柜中，運行程序。如圖7所示，涂膠機器人運行至作業(yè)目標(biāo)點，此時 KUKA 機器人的繼電器得電，膠泵閥門打開，膠槍開始出膠。當(dāng)機器人快速完成電芯的涂膠任務(wù)時，關(guān)閉膠泵閥門，涂膠機器人快速回到“HOME” 位置，可以看出，作業(yè)任務(wù)軌跡為“回”字形狀。

圖7 機器人涂膠流程

4 結(jié)束語

以電芯模組涂膠系統(tǒng)為研究對象實現(xiàn)了虛實相結(jié)合的6R 機器人作業(yè)任務(wù)開發(fā)。首先，對6R機器人進行了建模和運動分析；然后對KUKA機器人指令進行了解析，并介紹了離線示教編程、自動編程；最后由離線仿真系統(tǒng)生成相應(yīng)的控制程序，使機器人按照相應(yīng)的軌跡運動。避免了在線手動示教必須親臨現(xiàn)場、占用機器人工時和精度不穩(wěn)定的缺點，提高了生產(chǎn)效率，而且采用離線手動編程和自動編程相結(jié)合的方法可以節(jié)約編程時間，提高編程精度。