王慧東，張姝媛

（包頭職業(yè)技術(shù)學(xué)院，內(nèi)蒙古 包頭 014030）

1 機(jī)器人位姿描述

在空間坐標(biāo)系中，剛體的位置由三個(gè)移動(dòng)自由度確定，姿態(tài)由三個(gè)旋轉(zhuǎn)自由度確定。關(guān)節(jié)型機(jī)器人可視為由一系列關(guān)節(jié)連接起來的連桿組成，每一個(gè)連桿均可視為一個(gè)剛體。各桿件之間的相對(duì)位置和姿態(tài)方向稱為工業(yè)機(jī)器人的位姿。

空間中一剛體，若給定了剛體上某一點(diǎn)的位置和該剛體在空間的姿態(tài)，則這個(gè)剛體在空間上是唯一確定的，可用惟一一個(gè)位姿矩陣進(jìn)行描述。設(shè)o'、x'、y'、z'為剛體Q固連的一個(gè)坐標(biāo)系，則剛體Q在固定坐標(biāo)系中的位置可用齊次坐標(biāo)形式表示為：

令 n，o，a，分別為 x'，y'，z'坐標(biāo)軸的單位方向矢量，即

剛體的位姿可表示為（4×4）矩陣：

為了確定各連桿之間的相對(duì)運(yùn)動(dòng)和位姿關(guān)系，在每一個(gè)連桿上固接一個(gè)坐標(biāo)系，可用齊次變換來描述這些坐標(biāo)系之間的相對(duì)位置和姿態(tài)。通常把描述一個(gè)連桿坐標(biāo)系與下一個(gè)連桿坐標(biāo)系間相對(duì)關(guān)系的齊次變換矩陣叫作A1變換矩陣，簡(jiǎn)稱A1矩陣。如A1矩陣表示第一個(gè)連桿坐標(biāo)系相對(duì)固定坐標(biāo)系的位姿變換矩陣；A2矩陣表示第二個(gè)連桿坐標(biāo)系相對(duì)第一個(gè)連桿坐標(biāo)系的位姿變換矩陣：Ai表示第i個(gè)連桿坐標(biāo)系相對(duì)于第i-1個(gè)連桿坐標(biāo)系的位姿變換矩陣。那么，第二個(gè)連桿坐標(biāo)系在固定坐標(biāo)系中的位姿可用A1和A2的乘積來表示，即：

T2=A1A2

依此類推，對(duì)于六關(guān)節(jié)機(jī)器人，有下列矩陣：

T6=A1A2A3A4A5A6

該等式稱為機(jī)器人運(yùn)動(dòng)學(xué)方程。方程右邊為固定參考系到手部坐標(biāo)系的各連桿坐標(biāo)系之間變換矩陣的連乘；方程左邊T6表示這些矩陣的乘積，即機(jī)器人手部坐標(biāo)系（即默認(rèn)的工具坐標(biāo)系）相對(duì)于固定參考坐標(biāo)系的位姿，可寫成如下形式：

該矩陣前三列表示手部的姿態(tài)，第四列表示手部中心點(diǎn)的位置。

2 工業(yè)機(jī)器人坐標(biāo)系

工業(yè)機(jī)器人一般有四個(gè)坐標(biāo)系，即基坐標(biāo)系、關(guān)節(jié)坐標(biāo)系、工具坐標(biāo)系和工件坐標(biāo)系。

基坐標(biāo)系（即笛卡爾坐標(biāo)系），是機(jī)器人基座（連桿0）固接的坐標(biāo)系?；鴺?biāo)系原點(diǎn)位于J1與J2關(guān)節(jié)軸線的公垂線在J1軸線上的交點(diǎn)處，Z軸與關(guān)節(jié)軸線重合；X軸與J1與J2關(guān)節(jié)軸線的公垂線重合，從J1指向J2關(guān)節(jié)；Y軸按右手螺旋法則確定，坐標(biāo)系方向如圖1所示?；鴺?biāo)系是其它坐標(biāo)系的基礎(chǔ)。在基坐標(biāo)系中顯示的坐標(biāo)值就是工具坐標(biāo)系的位姿，即X、Y、Z值為工具坐標(biāo)系原點(diǎn)在基坐標(biāo)系中的位置，A、B、C值為工具坐標(biāo)系坐標(biāo)軸在基坐標(biāo)系中的姿態(tài)。

圖1 HSR-608工業(yè)機(jī)器人坐標(biāo)系

關(guān)節(jié)坐標(biāo)系，即為每個(gè)軸相對(duì)原點(diǎn)位置的絕對(duì)角度。已知各個(gè)關(guān)節(jié)變量的值，便可從基坐標(biāo)系通過連桿坐標(biāo)系的傳遞，推導(dǎo)出手部坐標(biāo)系的位姿形態(tài)。機(jī)器人控制系統(tǒng)對(duì)各關(guān)節(jié)正方向的定義可以簡(jiǎn)單地記為 J2、J3、J5關(guān)節(jié)以“抬起/后仰”為正，“降下/前傾”為負(fù)；J1、J4、J6關(guān)節(jié)滿足“右手定則”，即拇指沿關(guān)節(jié)軸線指向機(jī)器人末端，則其它四指方向?yàn)殛P(guān)節(jié)正方向。在關(guān)節(jié)坐標(biāo)系中可以進(jìn)行單個(gè)軸的移動(dòng)操作。

工具坐標(biāo)系，即安裝在機(jī)器人末端的工具坐標(biāo)系，原點(diǎn)及方向都是隨著末端位置與角度不斷變化的。HSR-608工業(yè)機(jī)器人默認(rèn)0號(hào)工具坐標(biāo)系位于J4、J5、J6關(guān)節(jié)軸線共同的交點(diǎn)處。Z軸與J6關(guān)節(jié)軸線重合；X軸與J5與J6關(guān)節(jié)軸線的公垂線重合；Y軸按右手螺旋法則確定，坐標(biāo)系方向如圖1所示。

工件坐標(biāo)系，即用戶自定義坐標(biāo)系。工件坐標(biāo)系是在工具活動(dòng)區(qū)域內(nèi)相對(duì)于基坐標(biāo)系設(shè)定的坐標(biāo)系?？赏ㄟ^坐標(biāo)系標(biāo)定或者參數(shù)設(shè)置來確定工件坐標(biāo)系的位置和方向。每一個(gè)工件坐標(biāo)系與標(biāo)定工件坐標(biāo)系時(shí)使用的工具相對(duì)應(yīng)。

規(guī)定以上坐標(biāo)系，目的在于對(duì)機(jī)器人進(jìn)行規(guī)劃和編程時(shí)提供一種參考標(biāo)準(zhǔn)。機(jī)器人移動(dòng)工具所應(yīng)到達(dá)的位姿，就是運(yùn)動(dòng)結(jié)束時(shí)工具坐標(biāo)系在基坐標(biāo)系或工件坐標(biāo)系中的位置和姿態(tài)的描述。機(jī)器人編程操作時(shí)，首先應(yīng)該理解工具坐標(biāo)系相對(duì)于基坐標(biāo)系或工件坐標(biāo)系的位姿。

3 工具坐標(biāo)系應(yīng)用

工具坐標(biāo)系用于描述安裝在機(jī)器人第六軸上的工具的TCP（工具中心點(diǎn)）、位姿等數(shù)據(jù)。機(jī)器人示教時(shí)，如果末端工具在小范圍內(nèi)要完成多個(gè)角度的位姿變換，則在工具坐標(biāo)系下移動(dòng)機(jī)器人比較方便。這時(shí)示教器顯示的坐標(biāo)軸X，Y，Z，就是工具的TCP點(diǎn)，A，B，C就是工具的姿態(tài)。

一般工業(yè)機(jī)器人默認(rèn)的工具TCP位于機(jī)器人安裝法蘭的中心點(diǎn)，而HSR-608工業(yè)機(jī)器人默認(rèn)工具坐標(biāo)系位于第五、第六關(guān)節(jié)軸線共同的交點(diǎn)，即手腕中心點(diǎn)。實(shí)際應(yīng)用中，不同功能的機(jī)器人會(huì)配置不同的工具，比如說弧焊的機(jī)器人使用弧焊槍作為工具，而用于搬運(yùn)板材等機(jī)器人就會(huì)使用吸盤式的夾具作為工具。工具TCP點(diǎn)及方向也會(huì)隨著末端安裝的工具位置與角度不斷變化。這就需要建立相應(yīng)的工具坐標(biāo)系，來描述所安裝的工具的TCP的位姿。

新建立的工具坐標(biāo)系總是相對(duì)于默認(rèn)的工具坐標(biāo)系定義的。它實(shí)際是將默認(rèn)工具坐標(biāo)系通過旋轉(zhuǎn)及位移變換而來。當(dāng)所使用的工具相對(duì)于默認(rèn)工具坐標(biāo)系只是TCP位置改變，而坐標(biāo)方向沒變時(shí)，可通過三點(diǎn)標(biāo)定法標(biāo)定工具坐標(biāo)系，或者將工具TCP的位置偏移量輸入到相應(yīng)的軸的坐標(biāo)值里即可建立新的工具坐標(biāo)系。當(dāng)TCP和坐標(biāo)方向都發(fā)生改變時(shí)，需要采用六點(diǎn)法建立新的工具坐標(biāo)系。

例如機(jī)器人搬運(yùn)應(yīng)用中使用搬運(yùn)的工具為真空吸盤，它的TCP點(diǎn)設(shè)定在吸盤的接觸面上，相對(duì)于默認(rèn)工具0的坐標(biāo)方向沒變，只是TCP相對(duì)于工具0在Z軸正方向偏移了L.所以，可采用修改Z軸的坐標(biāo)值的方法建立吸盤工具坐標(biāo)系；在機(jī)器人涂膠應(yīng)用中，涂膠工具的TCP點(diǎn)設(shè)定在膠槍底部端點(diǎn)位置，相對(duì)于默認(rèn)工具的坐標(biāo)方向沒變，只是TCP相對(duì)于工具的三個(gè)坐標(biāo)值發(fā)生改變。所以，也可以通過坐標(biāo)值設(shè)置建立膠槍坐標(biāo)系（如圖2所示）。

圖2 工具坐標(biāo)系變換示意圖

機(jī)器人噴漆或者弧焊應(yīng)用中，工具的TCP點(diǎn)設(shè)定在噴槍或者焊槍底部端點(diǎn)位置，相對(duì)于默認(rèn)工具0的坐標(biāo)方向和TCP都發(fā)生改變。所以，需采用六點(diǎn)法標(biāo)定工具坐標(biāo)系。

六點(diǎn)法是通過標(biāo)定機(jī)器人工具末端六個(gè)不同位置來計(jì)算工具坐標(biāo)系。工具坐標(biāo)系六點(diǎn)法標(biāo)定操作步驟如下：

第一步，首先在機(jī)器人工作范圍內(nèi)找到一個(gè)非常精確的固定點(diǎn)作為參考點(diǎn)。

第二步，然后在工具上確定一個(gè)參考點(diǎn)（最好是工具的中心點(diǎn)）。

第三步，用手動(dòng)操縱機(jī)器人的方法，去移動(dòng)工具上的參考點(diǎn)，以六種不同的機(jī)器人姿態(tài)盡可能與固定點(diǎn)剛好碰上。其中第四點(diǎn)是讓工具的參考點(diǎn)垂直于固定點(diǎn)，第五點(diǎn)是工具參考點(diǎn)從固定點(diǎn)向?qū)⒁O(shè)定為TCP的X方向移動(dòng)，第六點(diǎn)是工具參考點(diǎn)從固定點(diǎn)向?qū)⒁O(shè)定TCP的Z方向移動(dòng)。

第四步，機(jī)器人通過這六個(gè)位置點(diǎn)數(shù)據(jù)計(jì)算求得TCP的數(shù)據(jù)，并被保存。

4 工件坐標(biāo)系應(yīng)用

工件坐標(biāo)系是在工具活動(dòng)區(qū)域內(nèi)相對(duì)于基坐標(biāo)系設(shè)定的坐標(biāo)系。對(duì)機(jī)器人編程時(shí)可以在工件坐標(biāo)系中創(chuàng)建目標(biāo)和路徑。工件坐標(biāo)系下的坐標(biāo)值即為工具坐標(biāo)系在工件坐標(biāo)系中的位姿，其中X、Y、Z描述工具坐標(biāo)原點(diǎn)在工件坐標(biāo)系里的位置，A，B，C描述工具坐標(biāo)系X、Y、Z三個(gè)坐標(biāo)方向相對(duì)于工件坐標(biāo)系坐標(biāo)軸方向的角度偏移。

在工件坐標(biāo)系下示教編程有兩個(gè)優(yōu)點(diǎn)：

（1）當(dāng)機(jī)器人移動(dòng)位置之間有確定的關(guān)系時(shí)，可建立工件坐標(biāo)系，通過計(jì)算建立各點(diǎn)之間的數(shù)學(xué)關(guān)系，然后示教少數(shù)幾個(gè)點(diǎn)就可獲得全部點(diǎn)的位置數(shù)據(jù)。這樣，可減少示教點(diǎn)數(shù)，簡(jiǎn)化示教編程過程。

（2）當(dāng)機(jī)器人在不同工作區(qū)域內(nèi)的運(yùn)動(dòng)軌跡相同時(shí)，如在區(qū)域A中機(jī)器人的運(yùn)動(dòng)軌跡相對(duì)于區(qū)域A，與在區(qū)域B中機(jī)器人的運(yùn)動(dòng)軌跡相對(duì)于區(qū)域B相同，并沒有因?yàn)檎w偏移而發(fā)生變化。那么只需編制一個(gè)運(yùn)動(dòng)軌跡程序，然后建立兩個(gè)工件坐標(biāo)系A(chǔ)和坐標(biāo)系B，把工件坐標(biāo)系A(chǔ)和B的坐標(biāo)值賦值給當(dāng)前坐標(biāo)系即可，不需要重復(fù)編程。

例如使用HSR-JR608機(jī)器人在傳送帶上抓取產(chǎn)品，將其搬運(yùn)至左、右兩條傳送帶上的碼盤中，擺放整齊，然后周轉(zhuǎn)至下一工位進(jìn)行處理。

產(chǎn)品的擺放位置如圖3所示。位置2相對(duì)于位置1只是在X正方向偏移了一個(gè)產(chǎn)品長(zhǎng)度，只需在目標(biāo)點(diǎn)X數(shù)據(jù)上面加上一個(gè)產(chǎn)品長(zhǎng)度即可。位置4相對(duì)于位置3只是在X正方向偏移了一個(gè)產(chǎn)品寬度，只需在目標(biāo)點(diǎn)X軸數(shù)據(jù)上面加上一個(gè)產(chǎn)品寬度即可。依次類推，則可計(jì)算出剩余的全部擺放位置。示教編程時(shí)，只需要示教位置1和位置3兩個(gè)位置。

圖3 產(chǎn)品的擺放位置

在碼垛應(yīng)用過程中，通常是奇數(shù)層垛型一致，偶數(shù)層垛型一致，這樣只要計(jì)算出第一層和第二層之后，執(zhí)行第三層和第四層碼垛時(shí)，可將工件坐標(biāo)系在Z軸正方向上面疊加相應(yīng)的產(chǎn)品高度即可完成。

當(dāng)機(jī)器人在左右兩側(cè)碼垛時(shí)，機(jī)器人相對(duì)于左側(cè)碼盤的運(yùn)動(dòng)軌跡，與機(jī)器人執(zhí)行右側(cè)碼垛時(shí)相對(duì)于右側(cè)碼盤的運(yùn)動(dòng)軌跡是一樣的，并沒有因?yàn)檎w偏移而發(fā)生變化。所以，為了方便編程，給左邊碼盤建立工件坐標(biāo)系1，右邊碼盤建立工件坐標(biāo)系2.當(dāng)前工件坐標(biāo)系設(shè)置為坐標(biāo)系3，并在工件坐標(biāo)系3中進(jìn)行碼垛軌跡編程。執(zhí)行左側(cè)碼垛時(shí)，將左邊碼盤工件坐標(biāo)系1的各項(xiàng)位置數(shù)據(jù)賦值給當(dāng)前坐標(biāo)系3，機(jī)器人的運(yùn)動(dòng)軌跡就自動(dòng)更新到坐標(biāo)系1中。執(zhí)行右側(cè)碼垛時(shí)，將右邊碼盤工件坐標(biāo)系2的各項(xiàng)位置數(shù)據(jù)賦值給當(dāng)前坐標(biāo)系3，機(jī)器人的運(yùn)動(dòng)軌跡就自動(dòng)更新到坐標(biāo)系2中，這樣對(duì)于相同的軌跡就不需要重復(fù)編程了。

5 結(jié)束語

使用機(jī)器人工作時(shí)，首先應(yīng)該掌握機(jī)器人的位姿和坐標(biāo)系的意義和作用。機(jī)器人末端相對(duì)于固定坐標(biāo)系的位姿和運(yùn)動(dòng)是我們研究的重點(diǎn)。機(jī)器人位姿的數(shù)學(xué)描述對(duì)我們理解機(jī)器人的位姿，以及坐標(biāo)系的意義有重要的幫助。此外掌握各個(gè)坐標(biāo)系的使用方法，在編程時(shí)巧妙運(yùn)用這些坐標(biāo)系，可為編程帶來極大的方便。

[1]張培艷.工業(yè)機(jī)器人操作與應(yīng)用實(shí)踐教程[M].上海：上海交通大學(xué)出版社，2009.

[2]葉 暉，管小清.工業(yè)機(jī)器人實(shí)操與應(yīng)用技巧[M].北京：機(jī)械工業(yè)出版社，2010.

[3]葉 暉.工業(yè)機(jī)器人典型應(yīng)用案例精析[M].北京：機(jī)械工業(yè)出版社，2013.

[4]蘭 虎.焊接機(jī)器人編程及應(yīng)用[M].北京：機(jī)械工業(yè)出版社，2013.