[發(fā)明專利]用于工業(yè)機器人空間定位精度和軌跡測量的拉線式測量系統(tǒng)和測量方法

有效

• 申請?zhí)枺?/td>: 201410474330.4
• 申請日: 2014-09-17
• 公開（公告）號: CN104236629B
• 公開（公告）日: 2017-01-18
• 發(fā)明（設(shè)計）人: 鮑晟;宋韜;洪銀芳;何永義;郭帥;陸左鋒
• 申請（專利權(quán)）人: 上海大學(xué)
• 主分類號: G01D21/02
• 分類號: G01D21/02
• 代理公司: 上海上大專利事務(wù)所(普通合伙)31205
• 代理人: 陸聰明

技術(shù)領(lǐng)域

本發(fā)明涉及一種用于工業(yè)機器人空間定位精度和軌跡測量的拉線式測量系統(tǒng)和測量方法。

背景技術(shù)

工業(yè)機器人，作為生產(chǎn)自動化的代表，被廣泛應(yīng)用與工業(yè)的各個領(lǐng)域，如汽車制造、化工等行業(yè)自動化生產(chǎn)線上的弧焊、點焊、搬運、包裝等作業(yè)中。工業(yè)機器人在自動化生產(chǎn)中代替人完成高質(zhì)量的工作，提高了產(chǎn)品的生產(chǎn)效率和質(zhì)量，因此對工業(yè)機器人在運動時在空間上的準(zhǔn)確定位和速度、加速度的大小要有嚴(yán)格的要求。一般情況下，工業(yè)機器人出廠的時候都需要進(jìn)行定位精度的校準(zhǔn)，以及運動過程中速度和加速度的檢測。市場上現(xiàn)有的機器人校準(zhǔn)方式其一是采用攝像頭進(jìn)行跟蹤，采用手動編程，其精度低，且由于攝像光線等緣故對環(huán)境要求比較高；其二是采用激光干涉儀等跟蹤校準(zhǔn)，一般運用于機床上，其精度高，但空間檢測實現(xiàn)難度大，且價格昂貴。???????????????????

發(fā)明內(nèi)容

本發(fā)明的目的在于解決已有技術(shù)存在的問題，提供一種用于工業(yè)機器人空間定位精度和軌跡測量的拉線式測量系統(tǒng)和測量方法，其測量精度高，可靠性好，運動空間范圍大，而且對環(huán)境要求低，適用于工業(yè)現(xiàn)場。

為達(dá)到上述目的，本發(fā)明的構(gòu)思是：

利用拉線編碼器拉出的四條測試線纜，勾住機器人末端執(zhí)行器上安裝的測量適配器，使得四條測試線纜在延伸方向交于一點，根據(jù)數(shù)據(jù)采集卡反映的測試線纜的長度變化，以及測試線纜和測量桿的空間幾何關(guān)系，換算出機器人末端執(zhí)行器上的坐標(biāo)位置，并根據(jù)機器人連續(xù)移動時的坐標(biāo)位置描繪出實時運動軌跡，計算出機器人末端執(zhí)行器的速度和加速度。

根據(jù)上述發(fā)明構(gòu)思，本發(fā)明采用下述技術(shù)方案：

一種用于工業(yè)機器人空間定位精度和軌跡測量的拉線式測量系統(tǒng)，包括工業(yè)機器人，測量組件包括測量適配器，拉線編碼器，數(shù)據(jù)采集卡和計算終端；所述測量適配器安裝在工業(yè)機器人末端執(zhí)行器上；四個所述拉線編碼器通過四條測試線纜連接測量適配器，四個拉線編碼器的基點處于同一個平面且四點不共線，四條測試線纜的延長線在空間上交于一點；所述拉線編碼器通過導(dǎo)線連接數(shù)據(jù)采集卡，所述數(shù)據(jù)采集卡連接計算終端。

所述計算終端為臺式計算機或便攜式計算機。本系統(tǒng)還包括兩根測量桿，四個所述拉線編碼器分別安裝在測量桿的兩端上。

一種用于工業(yè)機器人空間定位精度和軌跡測量的拉線式測量方法，具體步驟如下：

a.?任意選取兩個拉線編碼器，通過數(shù)據(jù)采集卡反饋給計算終端兩條測試線纜的長度值，測量這兩個拉線編碼器的距離，得到由這三條邊構(gòu)成的三角形；

b.?通過迭代法計算得到測試線纜與底邊兩個拉線編碼器基點連線的夾角；

c.?通過三角形的空間幾何關(guān)系解得工業(yè)機器人末端執(zhí)行器上的點的空間坐標(biāo)初值；

d.?重復(fù)步驟a-c，得到由不同拉線編碼器兩兩配合得到的末端執(zhí)行器的空間坐標(biāo)值，進(jìn)行誤差最小化處理，最終得到末端執(zhí)行器點位坐標(biāo)；

e.?移動工業(yè)機器人的末端執(zhí)行器，使其改變位置，從而得到不同的測試線纜的長度值；重復(fù)步驟a-d，用計算終端計算得到末端執(zhí)行器不同的點位坐標(biāo)；

f.?操縱工業(yè)機器人，使末端執(zhí)行器運動，計算終端記錄下末端執(zhí)行器實時的空間坐標(biāo)位置，形成實時軌跡路線；根據(jù)采樣間隔，由計算終端得到的運動軌跡計算出末端執(zhí)行器的速度和加速度。

本發(fā)明與現(xiàn)有技術(shù)相比較，具有如下顯而易見的突出實質(zhì)性特點和顯著技術(shù)進(jìn)步：

本發(fā)明采用拉線編碼器作為測量的主體，利用拉線編碼器的測試線纜長度來換算機器人末端執(zhí)行器上的點位坐標(biāo)值變化，適用于工業(yè)現(xiàn)場，測試設(shè)備使用壽命長，機器人運動空間大，且測得的數(shù)據(jù)準(zhǔn)確性高。

附圖說明

圖1是本發(fā)明實施例一的測量裝置示意圖。

圖2是本發(fā)明實施例二的測量裝置示意圖。

具體實施方式

本發(fā)明的實施例結(jié)合附圖詳述如下：

實施例一：

參見圖1，一種用于工業(yè)機器人空間定位精度和軌跡測量的拉線式測量系統(tǒng)，包括工業(yè)機器人1，測量組件包括測量適配器2，測量桿3，拉線編碼器4，數(shù)據(jù)采集卡5和臺式計算機6；所述測量適配器2安裝在工業(yè)機器人1末端執(zhí)行器上；四個所述拉線編碼器4分別安裝在測量桿3的兩端上，四個所述拉線編碼器4通過四條測試線纜連接測量適配器2，四個拉線編碼器4的基點處于同一個平面且四點不共線，四條測試線纜的延長線在空間上交于一點；所述拉線編碼器4通過導(dǎo)線連接數(shù)據(jù)采集卡5，所述數(shù)據(jù)采集卡5連接臺式計算機6。本實施例中的數(shù)據(jù)采集卡5采用NI?PXI6602工控機。