一種六自由度焊接機器人的結(jié)構(gòu)設(shè)計和運動學(xué)分析

530004 廣西大學(xué)|王少龍

?

一種六自由度焊接機器人的結(jié)構(gòu)設(shè)計和運動學(xué)分析

530004 廣西大學(xué)|王少龍

與人工焊接相比，焊接機器人比較穩(wěn)定，具有較高的焊接質(zhì)量，可以保證焊縫均勻性；能夠一天可24小時連續(xù)工作，提高勞動生產(chǎn)率； 而且能改善工人勞動條件，可以在有毒、有害的環(huán)境下工作； 還可以降低對工人操作技術(shù)的要求，實現(xiàn)小批量產(chǎn)品的焊接自動化，為焊接柔性生產(chǎn)線提供技術(shù)基礎(chǔ)。本文對一種六自由度焊接機器人、建立機構(gòu)運動副的螺旋系，利用約束螺旋理論計算新型機構(gòu)的自由度，并采用閉環(huán)矢量法和約束方程建立機構(gòu)的正向運動學(xué)和逆向運動學(xué)模型。關(guān)鍵詞：焊接機器人；螺旋理論；運動學(xué)

并聯(lián)機器人具有無累積誤差，精度較高；結(jié)構(gòu)緊湊，剛度高，承載能力大等優(yōu)點［1］；且該機器人的連桿做成輕桿，使機構(gòu)運動慣量小，動力學(xué)性能好，與同類型的機器人機構(gòu)相比較，相同功率下做的功更多。

本文主要工作包括兩部分，一部分利用約束螺旋理論計算機構(gòu)的自由度；另一部分分析機構(gòu)的位置關(guān)系，首先運用閉環(huán)矢量法求解機構(gòu)的正運動學(xué)關(guān)系；其次，建立機構(gòu)的約束方程，求出整個機構(gòu)的逆運動學(xué)關(guān)系。

自由度的計算

對機構(gòu)最基礎(chǔ)的認(rèn)識就是要分析出它的自由度。自由度的正確計算是機構(gòu)創(chuàng)新設(shè)計的前提和基礎(chǔ)，鑒于傳統(tǒng)自由度計算公式的局限性，本章采用基于約束螺旋理論的自由度計算公式，首先分析了所設(shè)計焊接機器人的自由度。機構(gòu)的位置分析是機構(gòu)運動學(xué)分析的重要部分，主要研究機構(gòu)輸入與輸出之間的關(guān)系，為后續(xù)的速度分析、加速度分析、工作空間求解及其軌跡規(guī)劃提供理論基礎(chǔ)。

隨著機構(gòu)由平面到空間、由單自由度到多自由度、由串聯(lián)機構(gòu)到并聯(lián)機構(gòu)等的不斷發(fā)展，再利用傳統(tǒng)的自由度計算方法利用Grübler - Kutzbach 公式計算自由度常得不到準(zhǔn)確答案。因此本章采用約束螺旋理論對自由度旋轉(zhuǎn)移動式焊接機器人進(jìn)行自由度驗證，以確保計算求得自由度的準(zhǔn)確性，主要思想是先由結(jié)構(gòu)約束螺旋數(shù)目確定機構(gòu)的階數(shù)，再計算機構(gòu)的自由度。

圖1　旋量系

如圖1所示，設(shè)第i個轉(zhuǎn)動副的坐標(biāo)為（xiyi0），本機構(gòu)中共有7個轉(zhuǎn)動副和1個移動副，i=1，2，3，…8，因此運動螺旋系表示如下：

由于8個螺旋的Plücker坐標(biāo)中的第一和第六個元素均為0，與形位變化無關(guān)，因此通過觀察法可確定8個螺旋的4個反螺旋：

有4個反螺旋，因此機構(gòu)含有4個公共約束，故λ=4；修正的G-K公式為：

式（1）中，

M：機構(gòu)的自由度；

d ：機構(gòu)的階數(shù)；

n ：包括機架的構(gòu)件數(shù)目；

g ：運動副的數(shù)目；

fi：第i個運動副的自由度；

v ：多環(huán)并聯(lián)機構(gòu)在去除公共約束的因素后的冗余約束的數(shù)目；

故此機構(gòu)的自由度M為：

因此可求得該機器人具有6個自由度。

焊接機器人的運動學(xué)正解

圖2　機構(gòu)的坐標(biāo)系

對焊接機器人立柱以上部分機構(gòu)的分析可以將這部分機構(gòu)看作一個平面機構(gòu)。機構(gòu)簡圖如圖2所示，可將它看作是由一個平面五桿機構(gòu)和一個連桿機構(gòu)組合而成。計算它的運動學(xué)正解時，用拆分的方法可以得出輸入桿件角度與輸出點的位置關(guān)系。

a五桿機構(gòu)

通過對五桿機構(gòu)的分析可以得出θ2及C點的坐標(biāo)。

圖3　五桿機構(gòu)

如圖3，對于閉環(huán)BCDEF建立矢量方程

將式（3）的矢量分別向x、y軸方向投影，寫成標(biāo)量形式，整理得：

為了求θ2對上式進(jìn)行移項變化得：

將式（5）中二式兩端分別平方相加整理后得：

令：

則式（6）可整理得：

由于有：

上式中的A、B、C可以根據(jù)式（7）求得。另外，為保證方程（10）有實數(shù)根，主動件輸入?yún)?shù)θ1需要滿足判別式1Δ大于等于零。

對方程（10）求解可得：

方程（10）存在實數(shù)解的條件是判別式：

在求得θ2的前提下，C點的坐標(biāo)可以表示為：

當(dāng)輸入?yún)?shù)θ1，θ3，θ4已知時，結(jié)合以上各式即可求出C點的位置。

b連桿機構(gòu)

圖4　連桿機構(gòu)

連桿機構(gòu)部分如圖（4）所示，在C點坐標(biāo)已知的情況下，由矢量關(guān)系輸出點I的位置可表示為

結(jié)論

本文首先利用較好的自由度計算理論—約束螺旋理論計算出所設(shè)計機構(gòu)的自由度，保證機構(gòu)自由度計算的正確性；其次，分析了機構(gòu)的位置關(guān)系，采用閉環(huán)矢量法求出機構(gòu)的正運動學(xué)關(guān)系，采用約束方程的方法求出機構(gòu)的逆運動學(xué)關(guān)系。

參考：

［1］發(fā)明專利：一種六自由度旋轉(zhuǎn)移動式焊接機器人，申請公布號CN 104552268 A，審核中，還未授權(quán)。

［2］趙永生，鄭魁敬，李秦川，等.5-UPS/PRPU五自由度并聯(lián)機床運動學(xué)分析［J］.機械工程學(xué)報，2004，40（2）:12-16.