玻璃模具型腔等離子噴焊機器人運動仿真研究

王 倩，周一丹，周自強，張興國

（1. 南通大學(xué) 機械工程學(xué)院，南通 226019；2. 常熟理工學(xué)院，常熟 215500）

玻璃模具型腔等離子噴焊機器人運動仿真研究

王 倩1，周一丹1，周自強2，張興國1

（1. 南通大學(xué) 機械工程學(xué)院，南通 226019；2. 常熟理工學(xué)院，常熟 215500）

根據(jù)玻璃模具型腔等離子噴焊的工作條件和任務(wù)要求，對用于玻璃模具型腔等離子噴焊的機器人進行了參數(shù)設(shè)計，討論了該機器人的運動學(xué)問題。在MATLAB環(huán)境下，用 Robotics toolbox對該機器人的正運動學(xué)、逆運動學(xué)、軌跡規(guī)劃進行了仿真。通過仿真，觀察到了機器人各個關(guān)節(jié)的運動，并得到了相關(guān)數(shù)據(jù)，表明了設(shè)計參數(shù)的合理性。

玻璃模具型腔；等離子噴焊；機器人；軌跡仿真；MATLAB

0 引言

目前企業(yè)在玻璃模具生產(chǎn)中的一個重難點是要進行玻璃模具型腔關(guān)鍵部位的等離子噴焊以提高其耐磨、耐腐蝕和抗氧化等性能[1]，而現(xiàn)有的操作都是人工完成，工人需要將經(jīng)過預(yù)熱的玻璃模具（溫度高達650℃～700℃，重約15Kg）搬上或搬下焊機工作臺，導(dǎo)致了工人勞動強度大，工作效率低且存在著極大的安全隱患。為解決這一問題，擬采用機器人代替人工操作，對其進行了參數(shù)設(shè)計、運動學(xué)和軌跡規(guī)劃的仿真，尤其是對于小批量多品種（有時甚至是單件）的玻璃模具來說，提出了基于玻璃模具的CAD圖形直接生成噴焊機器人的運動軌跡而省略了現(xiàn)有的機器人示教或離線編程工作，將大大簡化了機器人的工作方式，提高了生產(chǎn)效率。這也符合信息集成的理念。

1 玻璃模具等離子噴焊機器人參數(shù)設(shè)計

根據(jù)企業(yè)玻璃模具等離子噴焊的整個過程要求，提出了玻璃模具型腔全過程自動噴焊系統(tǒng)方案，其由等離子噴焊機、機器人、玻璃模具電感加熱爐、供料傳送帶和成品存放區(qū)構(gòu)成，如圖1所示。

根據(jù)圖1所示系統(tǒng)布局方式和機器人所要完成的工作任務(wù)，機器人的結(jié)構(gòu)方案采用柱面坐標式機器人，如圖2（a）所示。主要由底座、立柱、水平手臂和末端執(zhí)行器構(gòu)成。水平手臂裝在立柱上，能水平方向上自由伸縮，并可沿立柱上下運動。立柱安裝在底座上，并與水平手臂一起能在底座上轉(zhuǎn)動。其中前兩個為移動關(guān)節(jié)，最后一個為轉(zhuǎn)動關(guān)節(jié)，這三個關(guān)節(jié)確定了末端執(zhí)行器的位置。在手臂末端的手腕處還有兩個轉(zhuǎn)動自由度，實現(xiàn)末端執(zhí)行器的姿態(tài)—俯仰和旋轉(zhuǎn)。此機器人取名為“robot-glass mould”。該柱面坐標式機器人位置精度高，控制簡單。其動作過程如圖3所示。

圖1 等離子噴焊機器人系統(tǒng)平面布局示意圖

圖2 “robot-glass mould”的實體模型及連桿坐標系

圖3 等離子自動噴焊機器人動作流程圖

按照機器人的整個動作過程和模具型腔全過程自動噴焊系統(tǒng)布局方案，表1給出了“robotglass mould”的連桿參數(shù)。其中，具體的參數(shù)d2，d3及d4是由預(yù)定的工作任務(wù)決定的，其余均按D-H變換[2]的定義進行設(shè)計。

表1 “robot-glass mould”的連桿參數(shù)

2 玻璃模具型腔等離子噴焊機器人運動學(xué)仿真算法

2.1 機器人運動學(xué)正問題

所謂運動學(xué)正問題[2,3]就是對于一機器人，給定桿件的幾何參數(shù)和關(guān)節(jié)的位移，求解末端連桿坐標系相對于基坐標系的位姿。

為求解運動學(xué)方程式，用齊次變換矩陣i－1Ti來描述第i坐標系相對于（i－1）坐標系的位置和方位，記作：

現(xiàn)在，將機器人的參數(shù)代入式（1），得到第i坐標系相對于機座坐標系位姿的齊次變換矩陣0Ti，表示為：

特別的當i＝5時，可求得0T5，它確定了機器人的末端相對于基坐標系的位置和姿態(tài)。表示為：

其中

2.2 機器人運動學(xué)逆解

機器人運動學(xué)逆問題就是已知末端連桿的位置和方位，求得機器人的各個關(guān)節(jié)變量，對于上述的“robot-glass mould”，需要求解的變量為q1，d2，d3，q4，q5。

機器人運動學(xué)逆問題的求解方法是：將運動方程式（3）的兩端依次左乘各T矩陣的逆矩陣，并使兩端相等矩陣的對應(yīng)元素相等，即可求得各關(guān)節(jié)變量。

求解關(guān)節(jié)變量的方程式如下：

3 玻璃模具型腔等離子噴焊機器人軌跡規(guī)劃

機器人軌跡規(guī)劃是根據(jù)機器人要完成的任務(wù)設(shè)計機器人各關(guān)節(jié)的運動規(guī)律。例如，對一般的工業(yè)機器人來說，操作員可能只輸入機械手末端的目標位置和方位，而規(guī)劃的任務(wù)便是要確定出達到目標的關(guān)節(jié)軌跡的形狀、運動的時間和速度等。這里所說的軌跡是指隨時間變化的位置、速度和加速度。軌跡規(guī)劃主要有兩種方案[3]：1）點到點運動（PTP）軌跡規(guī)劃；2）連續(xù)路徑運動（CP）的軌跡規(guī)劃。對于連續(xù)路徑運動，不僅要規(guī)定機械手的起始點和終止點，而且要指明兩點之間的若干中間點 （稱路徑點），必須沿特定的路徑運動（路徑約束）。

玻璃模具型腔等離子噴焊機器人將玻璃模具從預(yù)熱部位（設(shè)為點A）移動到等離子焊機下（設(shè)為點B），噴焊完成后再將其放到貨架區(qū)(設(shè)為點C)的運動路徑?jīng)]有要求，屬于PTP規(guī)劃。在噴焊過程中噴焊軌跡要沿著焊縫，因此屬于CP規(guī)劃。

4 MATLAB運動仿真

4.1 運動仿真

1）在對上述規(guī)劃軌跡進行仿真前，先使用link函數(shù)和robot函數(shù)建立機器人模型，用r.name為機器人命名為“robot-glass mould”。

命令如下：

2）按預(yù)定PTP軌跡進行仿真（由于篇幅有限，僅對A點到B點進行仿真示例），A點可表示為qA=[0 0 0 0 0]，即表示機器人的各個關(guān)節(jié)都處于零位置處。機器人在B點相對于基坐標系的位姿可用TB表示。然后，按運動學(xué)逆問題的解決方法，可以求得A到B的各個關(guān)節(jié)變量。下面用Robotics toolbox的逆運動學(xué)命令ikine( )來求解：

%說明機器人由A到B，關(guān)節(jié)1需正向轉(zhuǎn)動1.5708rad，關(guān)節(jié)2和3需向前移動0.2m和0.5m，最后兩個關(guān)節(jié)需分別逆向轉(zhuǎn)動3.1416rad和正向轉(zhuǎn)動1.5708rad。

3）用命令plot（ ）對機器人由A 到B 的運動進行仿真（取仿真時間為2s，采樣間隔時間為0.056s），這時就可以看到機器人各關(guān)節(jié)的具體運動情況，圖4給出了機器人運動到B時的三維圖。命令如下：

圖4 “robot-glass mould”運動到B點時的三維圖

4）按預(yù)定CP軌跡進行仿真

現(xiàn)有機器人可以通過示教噴焊區(qū)域的特征點，經(jīng)過軌跡規(guī)劃算法和逆運動學(xué)計算，得出噴焊區(qū)域的機器人噴焊仿真和實際噴焊操作，但是對于目前多品種小批量的玻璃模具來說，直接通過玻璃模具的AutoCAD圖紙文件得出機器人的噴焊操作將會大大提高生產(chǎn)效率，其設(shè)計思想流程見圖5所示。

圖5 焊縫噴焊軌跡規(guī)劃仿真思路流程圖

由于MATLAB從7.0版本就提供了一個實用的用戶圖形界面開發(fā)程序guide，它完全支持可視化編程，類似于Visual basic，因此，用戶可以十分方便地設(shè)計出高質(zhì)量的圖形用戶界面（GUI），設(shè)計的玻璃模具型腔等離子噴焊機器人的仿真界面如圖6所示。

圖6 玻璃模具型腔等離子噴焊機器人仿真界面

4.2 仿真結(jié)果分析

從運動仿真的前兩步，可以看出機器人前三個關(guān)節(jié)的運動可以滿足通常三自由度柱面坐標機器人的運動要求，即手臂可以實現(xiàn)水平方向上的自由伸縮，繞立柱的轉(zhuǎn)動和沿立柱的上下運動，從而驗證了連桿1，2，3的連桿參數(shù)設(shè)計的合理性。機器人后兩個關(guān)節(jié)的運動可以使末端關(guān)節(jié)具有不同的姿態(tài)（實現(xiàn)俯仰和旋轉(zhuǎn)），也說明了設(shè)計的參數(shù)是合理的。

在運動仿真的第（3）步，我們觀察到機器人由A運動到B時各個關(guān)節(jié)的運動情況（文中無法顯示這一運動過程），且各個關(guān)節(jié)運動情況均為正常，各連桿沒有運動錯位的情況，從而驗證了所有連桿參數(shù)的合理性，且各參數(shù)的設(shè)計能夠?qū)崿F(xiàn)預(yù)定的目標。

在圖6所示的仿真界面中，逆運動學(xué)仿真得到的5個關(guān)節(jié)的運動情況也是合理的。

5 結(jié)束語

根據(jù)玻璃模具型腔等離子噴焊的工作環(huán)境和工作任務(wù)，對機器人進行了參數(shù)設(shè)計，分析了它的運動學(xué)問題和軌跡規(guī)劃問題。在MATLAB環(huán)境下，編制簡單的程序語句，對該機器人已規(guī)劃好的軌跡進行了運動學(xué)仿真，驗證了參數(shù)的合理性，達到了良好的效果。

[1] 葉宏. 玻璃模具的激光合金化處理[J]. 激光雜志, 2000(4)： 48-49.

[2] 蔡自興. 機器人學(xué)[M]. 北京： 清華大學(xué)出版社, 2000.

[3] 朱世強. 機器人技術(shù)及其應(yīng)用[M]. 浙江： 浙江大學(xué)出版社, 2001.

[4] 陳世健, 張鐵. 基于Matlab的噴涂機器人運動學(xué)分析[J].機電產(chǎn)品開發(fā)與創(chuàng)新, 2008, 21(5)：4-5,18.

[5] 王素玲. BC31環(huán)境下DXF圖像文件實體數(shù)據(jù)的提取[J].新鄉(xiāng)師范高等?？茖W(xué)校學(xué)報, 1999, 13(1)： 113-115.

[6] 樊炳輝. C語言構(gòu)造DXF圖形交換文件的應(yīng)用[J]. 微型電腦應(yīng)用, 1998(3)： 86-89.

Study on the simulation of glass mould plasma spray welding robot motion

WANG Qian1, ZHOU Yi-dan1, ZHOU Zi-qiang2, ZHANG Xing-guo1

TP24

A

1009-0134(2011)5(下)-0116-04

10.3969/j.issn.1009-0134.2011.5(下).35

2010-12-18

蘇州市科技計劃項目：基于工業(yè)機器人技術(shù)的玻璃模具等離子噴焊加工流水線（ZXG0914）； 江蘇省普通高校研究生科研創(chuàng)新計劃項目

王倩（1985－），女，江蘇徐州人，碩士研究生，研究方向為先進制造工藝及自動加工技術(shù)。