6DOF焊接機器人運動學分析及仿真

寧青杰，施立品，唐 兵，張寶寧

（中國礦業(yè)大學（北京）機電與信息工程學院，北京 100083）

1 引言

液壓支架結構件尺寸大，多為拼焊而成的箱型結構件，需要由多個小跨度焊接機器人同時焊接，作業(yè)效率較低[1]。隨著大采高開采以及深部開采的煤礦的日益增多，液壓支架面臨著更加嚴峻的考驗，其失效的可能性不斷上升，機械設備需要更高的可靠性。液壓支架承受重載和沖擊的主要零部件多由中厚板材焊接而成的箱型結構件組成。液壓支架的強度直接影響煤礦安全生產［2］。

機器人的智能化促進了焊接技術的不斷創(chuàng)新[3]。焊接機器人不僅能夠高質量地完成焊接任務，而且也能代替工人完成既危險又復雜的高強度工作，從而節(jié)省人力資源，降低生產成本，在國內外均有著廣闊的應用前景。通過仿真，可節(jié)省優(yōu)化焊接軌跡所用的時間，提高焊接效率，滿足生產需求[4]。機器人末端手腕（TCP）所能到達的工作區(qū)域以及角位移、角速度和角加速度的連續(xù)性是衡量焊接效率、精度和質量的重要指標[5]，是焊接機器人設計、運動學分析和運動控制過程中亟待處理和解決的關鍵性問題。

在求解機器人工作空間的多種方法中，數(shù)值法的應用最為廣泛。蒙特卡洛法[6]是一種數(shù)值分析方法，在多于三自由度的機器人研究中，通常用于求解其工作空間[7]。采用數(shù)值分析方法，通過調用Robotics Toolbox工具箱中的5次多項式jtraj函數(shù)，對關節(jié)空間PTP軌跡規(guī)劃進行仿真分析研究。

2 焊接機器人正運動學分析

液壓支架焊接機器人是專門針對液壓支架大型結構件的焊接任務所配備的專用工業(yè)機器人，以六自由度串聯(lián)機器人居多。焊接機器人SR165的空間結構圖，如圖1所示。

圖1 焊接機器人SR165的空間結構圖Fig.1 Space Structure Diagram of Welding Robot SR165

2.1 建立連桿坐標系

焊接機器人SR165由多個關節(jié)軸和連桿組成，在三維空間中實現(xiàn)多自由度運動。用ai、αi、di和θi四個參數(shù)來描述相鄰兩桿之間的相對關系[8]，分別稱為連桿長度、連桿扭角、連桿偏距和關節(jié)轉角，如圖2所示。

圖2 連桿關節(jié)軸關系圖Fig.2 Connecting Rod Joint Axis Diagram

建立相對應的坐標系后再進行相互轉換，可得焊接機器人SR165末端焊槍的位姿。這種用連桿參數(shù)表達機械機構運動的方法稱為Denavit?Hartenberg參數(shù)法[9?10]，簡稱D?H參數(shù)法。

2.2 正運動學模型建立與求解

2.2.1 正運動學建模

焊接機器人末端焊槍的位置和姿態(tài)由連桿運動鏈相鄰連桿的運動狀態(tài)疊加而成，通過D?H參數(shù)法進行描述。假設桿1相對于基坐標的位姿表達為，那么桿i相對于基坐標的最終位姿就是前面相鄰齊次變換矩陣相乘后的積。

式中：[n o a]—姿態(tài)向量；

P—位置向量。

在串聯(lián)的運動鏈中，相鄰兩連桿之間的廣義變換矩陣如下：

式中：αi?1—連桿扭角；ai?1—連桿長度；θi—關節(jié)轉角；di—連桿偏距。

機器人SR165以垂直關節(jié)居多，采用經(jīng)典D?H參數(shù)法建模，以下為機器人各關節(jié)的運動簡圖，如圖3所示。

圖3 機器人SR165關節(jié)運動簡圖Fig.3 Robot SR165 Joint Motion Diagram

從圖3可知，前、后三個關節(jié)分別決定了焊接機器人SR165前端的焊槍在工作空間中的位置和姿態(tài)。

根據(jù)D?H 參數(shù)法，確定相鄰坐標系之間的變化轉換關系。焊接機器人SR165的D?H參數(shù)，如表1所示。

表1 機器人SR165 D-H參數(shù)Tab.1 D-H Parameters of Robot SR165

2.2.2 正運動學求解

根據(jù)機器人設計值確定出四個連桿參數(shù)，代入公式（3）即可求得相鄰兩桿之間的位姿變換矩陣：

式中：cθi=cos(θi)；sθi=sin(θi)；cαi?1=cos(αi?1)；sαi?1=sin(αi?1)。分別帶入αi?1、ai?1、θi和di，可得轉換矩陣分別為

上面每一個相鄰桿件的變換矩陣都是關于轉角θi的函數(shù)，把帶入?yún)?shù)的六個變換矩陣依次相乘計算出四階的位姿變換矩陣，若六個轉角θi值已知，便可確定末端焊槍位姿，轉換矩陣如下：

式中：[nx ny nz]T、[ox oy oz]T、[ax ay az]T—機器人SR165焊槍末端姿態(tài)坐標向量；[px py pz]T—位置坐標向量。通過MATLAB的求解運算獲得變換矩陣，這個（4×4）矩陣中的12個元素分別為：

式中：c23和s23是cos（θ2+θ3）和sin（θ2+θ3）的簡寫，其中i，j=1…6。

3 焊接機器人逆運動學分析

3.1 逆運動學代數(shù)求解

上節(jié)通過建立焊接機器人SR165正運動學模型，計算出（4×4）階的轉換矩陣，把已知各關節(jié)的實際旋轉角度值代入正解方程，即可得到機器人SR165末端焊槍的位姿。

用齊次矩陣形式建立機器人SR165數(shù)學模型，用矩陣法計算機器人的逆解，六個關節(jié)角的求解過程如下。

3.1.1 求解θ1

使方程（6）兩邊矩陣（2，4）元素分別對應相等可得：

計算可得：

θ1=atan()，易知θ1有唯一解。

3.1.2 求解θ2

使方程（8）等式兩邊矩陣（1，4）和（2，4）元素對應相等可得：

移項，方程（10）變?yōu)橄率剑?/p>

令k1=c1rx+s1ry，

方程（10）和（11）兩邊平方后分別對應相加可得：

易知θ2有兩個解。

3.1.3 求解θ3

式（11）中：令k3=c2(c1rx+s1ry)?s2rz?a1c2?a2

3.1.4 求解θ4、θ5

使方程（13）等號兩邊矩陣（1，3）、（2，3）和（3，3）元素分別對應相等可得：

由式（14）和式（16）可得：

由（15）可得：θ5=±arcos(?r33c23?c1r13s23?r23s1s23)

易知θ4有唯一解，θ5有兩個解。

3.1.5 求解θ6

使方程（13）等式兩邊矩陣（2，1）和（2，2）元素分別對應相等可得：

聯(lián)立式（17）和式（18）可得：

綜上所述，對于焊接機器人SR165的同一種位姿，共有8種可能的關節(jié)角度組合。

4 SR165焊接機器人工作空間分析

4.1 6DOF焊接機器人工作范圍分析

運用集合的概念，焊接機器人SR165的工作空間為其末端焊槍所能到達的三維空間中所有點的集合，其工作空間的數(shù)學表示，如式（19）所示。

4.2 蒙特卡羅法工作域分析

蒙特卡羅法是一種可用于求解機器人工作空間的基于隨機概率的數(shù)值法。用該方法求解機器人的工作空間可分為以下四個步驟：

（1）由正運動學方程可得末端點的位置向量如下：

式中：a1=350mm；a2=1100mm；a3=260mm；d4=1110mm。

（2）確定各關節(jié)的轉角范圍，調用MATLAB中的隨機值函數(shù)RAND（），用最大轉角減去最小轉角后與RAND（）函數(shù)相乘，即可得到各關節(jié)轉角相對應的步長變量，即(?)×RAND()，從而可得各關節(jié)隨機變量為：

（3）將式（21）中的六個隨機變量分別帶入到式（20）中的元素Px、Py和Pz中，即可得到焊接機器人SR165末端焊槍所能到達的所有空間點集。

（4）根據(jù)具體要求設置循環(huán)次數(shù)，通過MATLAB編程實現(xiàn)該算法，輸出結果，實現(xiàn)工作空間仿真分析。以下為蒙特卡羅法步驟[12]，如圖4所示。

圖4 蒙特卡羅法步驟示意圖Fig.4 Monte Carlo Method Steps

圖5 二維及三維工作空間云圖Fig.5 2D and 3D Workspace Cloud Map

從圖5可知，焊接機器人SR165末端焊槍所能到達的區(qū)域與仿真工作空間的尺寸相對應，分布在各個投影面上的隨機點組成的云圖較均勻，沒有明顯空洞現(xiàn)象。焊接機器人SR165工作空間云圖形狀緊湊，MATLAB仿真結果與實際工作空間相一致，能夠滿足大范圍跨度鋼件的焊接要求。

5 6DOF焊接機器人末端軌跡規(guī)劃

空間軌跡規(guī)劃包括關節(jié)空間規(guī)劃與笛卡爾空間規(guī)劃[14]，兩種軌跡規(guī)劃各有優(yōu)缺點。充分利用兩種規(guī)劃的優(yōu)點，使其末端既能到達指定的位置又能使其末端軌跡連續(xù)平滑，5.1節(jié)中使用MAT‐LAB軟件對焊接機器人SR165進行建模，并分別對兩種規(guī)劃進行仿真分析。

5.1 6DOF焊接機器人MATLAB三維建模

使用Robotics Toolbox 工具箱，對焊接機器人SR165進行三維建模，調用SerialLink函數(shù)將六個連桿連接起來構成一個運動鏈，生成的機器人SR165模型，如圖6所示。調用teach函數(shù)彈出機器人關節(jié)驅動器，可以通過調節(jié)或鍵入弧度值實現(xiàn)機器人驅動效果，如圖7所示。通過滑動滑塊即可將機器人末端焊槍運動到指定的位姿。

圖6 焊接機器人在qA狀態(tài)下的三維圖Fig.6 3?D Diagram of the Welding Robot in qA State

圖7 焊接機器人驅動調節(jié)器Fig.7 Welding Robot Drive Regulator

5.2 關節(jié)空間軌跡規(guī)劃

調用Robotics Toolbox 工具箱中的q=jtraj（qA，qB，t）函數(shù)，其中分別表示各個關節(jié)的起點和終點的角度，默認的起點和終點速度均為零［3］。使用畫圖命令plot可以得到焊接機器人在qB狀態(tài)下的三維圖，如圖8所示。使用畫圖命令plot3可以得到焊接機器人在qB狀態(tài)下末端軌跡圖，如圖9所示。

圖8 焊接機器人在qB狀態(tài)下的三維圖Fig.8 3?D Diagram of the Welding Robot in qB State

圖9 焊接機器人末端軌跡Fig.9 End Trajectory of Welding Robot

為了在關節(jié)空間中規(guī)劃機器人的運動軌跡，需要設定運動起點與終點，取起點qA=［0 ?pi/2 ?pi/2 0pi/2 0］，終點qB=［pi/2pi/3 0?pi/6 ?pi/3 ?pi/2］，運動時間設定為10s，分別對六個關節(jié)進行仿真分析研究。

調用jtraj函數(shù)對焊接機器人SR165關節(jié)空間進行5次多項式插值，調用plot中的q、qd和qdd函數(shù)，得到各關節(jié)的角位移、角速度和角加速度隨時間變化的曲線圖，分別如圖10、圖11和圖12所示。

圖10 各關節(jié)角位移曲線Fig.10 Angular Displacement Curve of Each Joint

圖11 各關節(jié)角速度曲線Fig.11 Angular Velocity Curve of Each Joint

觀察圖10~圖12中曲線，可知機器人SR165在運動過程中角位移、角速度和角加速度曲線光滑平穩(wěn)，無突變位置，說明機器人各個連桿之間沒有發(fā)生錯位的現(xiàn)象，角位移從起點隨著時間的推移運動到終點，各關節(jié)的角位移均未出現(xiàn)突變現(xiàn)象。

圖12 各關節(jié)角加速度曲線Fig.12 Angle Acceleration Curve of Each Joint

關節(jié)1、2、3的角速度前5s逐漸上升，5s時達到最大速度，后5s逐漸下降為零，關節(jié)4、5、6的角速度恰好相反。

各個關節(jié)角加速度先正后負與其各關節(jié)速度先增大后減小相對應，因此該關節(jié)空間軌跡規(guī)劃是合理的。

5.3 笛卡爾空間軌跡規(guī)劃

以直線為例進行笛卡爾空間軌跡規(guī)劃，取起點T1=transl（378.16，1753.39，1023.82），終點T2=（587.932，1720.327，880.306），運行時間設為10s，調用Robotics Toolbox 工具箱中的五次多項式函數(shù)ctraj，對機器人SR165進行運動軌跡規(guī)劃，調用plo（tt，T（j：，i））函數(shù)可得出機器人SR165末端焊槍在10s內連續(xù)的空間坐標，如圖13所示。

圖13 機器人末端三維空間坐標Fig.13 3?D Space Coordinates of the Robot End

通過調用程序語句plot3（T（j：，1），T（j：，2），T（j：，3））可得出機器人SR165末端焊槍在工作空間中的直線運行軌跡，如圖14所示。

圖14 機器人末端空間運動軌跡Fig.14 Robot End Space Motion Trajectory

為了確定該直線軌跡規(guī)劃是否合理，通過仿真得出機器人SR165運動過程中轉角的變化范圍，運行程序可得各關節(jié)轉角的變化曲線，如圖15所示。

圖15 各關節(jié)角度變化曲線Fig.15 Angle Change Curve of Each Joint

焊接機器人實物圖，如圖16所示。

圖16 焊接機器人實物圖Fig.16 Welding Robot Physical Picture

6 結論

（1）使用MATLAB 軟件編寫程序，仿真分析了焊接機器人SR165的工作空間，結果表明，焊接機器人SR165工作空間范圍跨度大，能滿足大空間焊接鋼件的要求，與期望可達工作區(qū)域相符。

（2）采用兩種軌跡規(guī)劃方法進行仿真分析，結果表明，焊接機器人SR165末端焊槍運動時的角位移、角速度和角加速度曲線連續(xù)、平滑，均未出現(xiàn)突變現(xiàn)象，使得中厚板結構件焊接能夠高質量地完成大范圍跨度和無突變性焊接的任務。

（3）通過對焊接機器人SR165進行運動學分析，保證了箱型結構件的焊接效率、精度和質量，液壓支架的安全性得到進一步提升，對現(xiàn)代智能化采煤有著極其重要的基礎意義，為后續(xù)SR165焊接機器人動、靜力學及運動控制分析研究奠定了一定的理論基礎。