一種機器人的標(biāo)定系統(tǒng)及方法
【技術(shù)領(lǐng)域】
[0001] 本發(fā)明涉及一種機器人的標(biāo)定系統(tǒng)及方法，屬于機器人標(biāo)定領(lǐng)域。
【背景技術(shù)】
[0002] 隨著機器人在各個行業(yè)的廣泛運用，業(yè)界對工業(yè)機器人在運動時在空間上的重復(fù) 定位精度與絕對定位精度有嚴(yán)格的要求，現(xiàn)今機器人重復(fù)定位精度比較高，絕對定位精度 卻很低，一般相差一個數(shù)量級以上，絕對定位精度問題已經(jīng)嚴(yán)重制約了工業(yè)機器人的應(yīng)用 能力和應(yīng)用范圍。由于機器人是一種多自由度設(shè)備，這種結(jié)構(gòu)形式存在誤差累積放大的缺 點，各級關(guān)節(jié)的結(jié)構(gòu)參數(shù)誤差會被逐級放大，從而造成機器人的精度降低。
[0003] 標(biāo)定是消除機器人結(jié)構(gòu)參數(shù)誤差的有效方法，目前常用的機器人標(biāo)定方法一般都 要借助激光跟蹤儀、激光干涉儀、三坐標(biāo)測量機等精密測量儀器。
[0004] 以上方法的共同特點是設(shè)備非常昂貴，安裝調(diào)試及操作比較復(fù)雜，主要適合于機 器人制造企業(yè)實驗室場合應(yīng)用，操作過程依賴于操作人員的水平且非常浪費時間，難以實 現(xiàn)自動化。

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

[0005] 本發(fā)明提供了一種機器人的標(biāo)定系統(tǒng)及方法，以解決現(xiàn)有設(shè)備昂貴、安裝操作復(fù) 雜或定位精度低等問題。
[0006] 本發(fā)明的技術(shù)方案是：一種機器人的標(biāo)定系統(tǒng)，包括標(biāo)定裝置、機器人19、計算機 20、機器人電纜21、標(biāo)定裝置電纜；
[0007] 所述標(biāo)定裝置通過標(biāo)定裝置電纜與計算機20連接通訊，機器人19通過機器人電纜 21與計算機20連接通訊;通過計算機20采集標(biāo)定裝置的數(shù)據(jù)以及機器人19的關(guān)節(jié)轉(zhuǎn)角，并 根據(jù)連續(xù)兩次采集到標(biāo)定裝置的數(shù)據(jù)計算機器人19末端在空間兩點的距離;所述標(biāo)定裝置 的數(shù)據(jù)包括拉線傳感器17的拉線長度、角度傳感器15的角度、角度傳感器Π 14的角度。
[0008] 所述標(biāo)定裝置包括下底板1、軸承座12、圓錐滾子軸承13、阻擋片4、角度傳感器15、 旋轉(zhuǎn)軸16、軸承座Π 7、圓錐滾子軸承Π 8、支撐柱9、上底板10、連接塊11、旋轉(zhuǎn)軸Π 12、轉(zhuǎn)向 環(huán)13、角度傳感器Π 14、深溝球軸承115、深溝球軸承Π 16、拉線傳感器17、連接桿18;
[0009] 所述軸承座12安裝在下底板1上，圓錐滾子軸承13安裝于軸承座12內(nèi)，旋轉(zhuǎn)軸16的 下端安裝在圓錐滾子軸承13內(nèi)，角度傳感器15安裝在旋轉(zhuǎn)軸16上，阻擋片4一端安裝在角度 傳感器15上，阻擋片4另一端安裝在下底板1上，軸承座Π 7安裝在上底板10上，上底板10與 下底板1通過支撐柱9連接，圓錐滾子軸承Π 8安裝于軸承座Π 7內(nèi)，旋轉(zhuǎn)軸16的上端安裝在 圓錐滾子軸承Π 8內(nèi)，連接塊11安裝在旋轉(zhuǎn)軸16的末端，連接塊11 一端安裝有深溝球軸承I 15，連接塊11另一端安裝有深溝球軸承Π 16，旋轉(zhuǎn)軸Π 12的一端安裝在深溝球軸承115內(nèi)， 旋轉(zhuǎn)軸Π 12的另一端安裝在深溝球軸承Π 16內(nèi)，轉(zhuǎn)向環(huán)13安裝在旋轉(zhuǎn)軸Π 12上，隨旋轉(zhuǎn)軸 Π 12-起轉(zhuǎn)動，拉線傳感器17的拉線安裝在轉(zhuǎn)向環(huán)13上，連接桿18安裝在拉線傳感器17上， 角度傳感器Π 14的轉(zhuǎn)動軸安裝在旋轉(zhuǎn)軸Π 12上，角度傳感器Π 14安裝在連接塊11上。
[0010] 所述標(biāo)定裝置電纜包括拉線傳感器電纜22、角度傳感器電纜Π 24、角度傳感器電 纜 123;
[0011] 所述標(biāo)定裝置中拉線傳感器17、角度傳感器15、角度傳感器Π 14分別通過拉線傳 感器電纜22、角度傳感器電纜Π 24、角度傳感器電纜123與計算機20連接通訊。
[0012] -種機器人的標(biāo)定方法，所述方法的具體步驟如下：
[0013] Stepl、將拉線傳感器17通過連接桿18固定在機器人19上，并將拉線傳感器17的拉 線與轉(zhuǎn)向環(huán)13連接，從而實現(xiàn)標(biāo)定裝置與機器人19的連接；
[0014] Step2、上電，打開拉線傳感器17、角度傳感器15、角度傳感器Π 14、機器人19，并將 機器人19移動至初始位姿且滿足初始化計數(shù)變量v = 0;
[0015] Step3、判斷是否完成數(shù)據(jù)采集操作；
[0016]若已經(jīng)完成數(shù)據(jù)采集則轉(zhuǎn)至Step7,若尚未完成則轉(zhuǎn)至Step4;
[0017] Step4、計數(shù)變量自增l:v = v+l;
[0018] Step5、通過計算機20采集拉線傳感器17的拉線長度、角度傳感器15的讀數(shù)、角度 傳感器Π 14的讀數(shù)(為拉線傳感器17的拉線在豎直方向上與水平面的夾角）和機器人19的 關(guān)節(jié)轉(zhuǎn)角數(shù)據(jù)；
[0019] St ep6、變換機器人19的位姿，變換的原則為:按照關(guān)節(jié)順序的大小依次變換每個 關(guān)節(jié)的轉(zhuǎn)角（如：按照關(guān)節(jié)從小到大的原則依次變換，關(guān)節(jié)一從0°變換到10°，下一次再從 10°變換到20°，以此類推，每次變換關(guān)節(jié)的角度增加10°，一直增加到350°，即完成此關(guān)節(jié)的 位姿變換，其余關(guān)節(jié)也按照這種方法運動，用戶也可增加或減少位姿的變換次數(shù)，以便獲得 更多數(shù)據(jù)）；其中所有關(guān)節(jié)變換次數(shù)為t，每變換一次就返回到步驟Step3進行判斷；
[0020] Step7、完成數(shù)據(jù)采集后令t = v;
[0021 ] Step8、機器人19末端空間連續(xù)兩點i與j距離I i, j的計算：
[0022]數(shù)據(jù)采集完成后，利用采集到的標(biāo)定裝置的數(shù)據(jù)可計算機器人19末端空間連續(xù)兩 點i與j距離1^;由于旋轉(zhuǎn)軸16的軸線，旋轉(zhuǎn)軸Π 12的軸線，拉線傳感器17拉線的延長線相 交于同一點〇,轉(zhuǎn)向環(huán)13末端到〇點的距離為1〇,因此能建立機器人19末端空間連續(xù)兩點i與 j距離的空間幾何關(guān)系，求出h,^選擇旋轉(zhuǎn)軸Π 12軸線所在平面為水平面，首先根據(jù)拉 線傳感器17的拉線長度以及角度傳感器Π 14的讀數(shù)計算機器人19末端位置i、j到水平面投 影點k、p的距離I1,k、U P;其次根據(jù)拉線傳感器17的拉線長度、角度傳感器15與角度傳感器 Π 14的讀數(shù)計算投影點的長度lk,P，最后根據(jù)勾股定理即可計算出機器人19末端空間連續(xù) 兩點i與j距離；
[0023]機器人19末端位置i與j到投影點k與p距離h,的計算：
[0024] li,k= (li+lo)sin9i
[0025] lj,p = (lj+lo)sin9j
[0026] 投影點長度lk,P的計算：
[0027] l〇,k=(li+lo)cos9i
[0028] l〇,p = (lj+lo)cos0j
[0029] 根據(jù)余弦定理lk,P2 = Iikhlc^p2HA · 1。,p · cos9k,p，得到lk,p;
[0030] 機器人19末端位置i與j距離的計算：
[0031] ln,k=lj,p
[0032]
[0033]
[0034] 根據(jù)勾股定理
求出機器人19末端在空間兩點i與j之間的距離 li, j;式中，Ii、Ij表不當(dāng)機器人19末端位置分別為i、j時，拉線傳感器17的拉線長度;0i、0j表 示當(dāng)機器人19末端位置分別為i、j時，角度傳感器Π 14的讀數(shù);0k、θρ表示當(dāng)機器人19末端位 置分別為i、j時，角度傳感器15的讀數(shù)；0 k,p為機器人19末端由位置i移動到位置j時在水平 面轉(zhuǎn)過的角度，01<,1) = 91{-91);11為」點在線11^上的投影點；1。,1{、1。, 1)分別表示〇點至投影點1^的 距離；ln,k、Uj分別表示η至k、j的距離；h, n表示i至η的距離；
[0035 ] Step9、待標(biāo)定的機器人19結(jié)構(gòu)參數(shù)的求解：
[0036] 利用采集到的機器人19的關(guān)節(jié)轉(zhuǎn)角數(shù)據(jù)，計算得到的I1^以及機器人19的運動學(xué) 方程列出t個方程，每個方程形式為：
[0037]
[0038] 器人19末端位置位于i時的坐標(biāo)值，， θ1>2,…，01>w表示機器人19末端位置位于i時的w個關(guān)節(jié)轉(zhuǎn)角值，q為待辨識的機器人19結(jié)構(gòu) 參數(shù)向量；
[0039]
表示機器人19末端位置位于j時的坐標(biāo)值，θ^， Θ j, 2，…，Θ j, ?表不機器人19末端位置位于j時的w個關(guān)節(jié)轉(zhuǎn)角值；
[0040] SteplO、求解t個方程組成的方程組：
[0041]
[0042] 在上面的方程組中，只有待辨識的機器人19的結(jié)構(gòu)參數(shù)向量q是不確定的，利用非 線性最小二乘法即可求解，得到結(jié)構(gòu)參數(shù)向量q的精確值；
[0043] Stepll、將結(jié)構(gòu)參數(shù)向量q代入機器人19的運動學(xué)方程中，驗證標(biāo)定結(jié)果的有效 性，完成機器人19的標(biāo)定。
[0044]本發(fā)明的工作原理是:將拉線傳感器17通過連接桿18固定在機器人19上，通過計 算機20采集拉線傳感器17、角度傳感器15、角度傳感器Π 14的讀數(shù)以及機器人19的關(guān)節(jié)轉(zhuǎn) 角，并根據(jù)連續(xù)兩次采集到的拉線傳感器17、角度傳感器15、角度傳感器Π 14的數(shù)據(jù)計算出 機器人19末端在空間兩點的距離，根據(jù)機器人7的末端在空間兩點的距離以及機器人19的 運動學(xué)方程得到以機器人19結(jié)構(gòu)參數(shù)為未知量的方程式，按照關(guān)節(jié)變換順序改變機器人19 的位姿可以得到一系列的方程式，聯(lián)立所得到的方程式即可得到結(jié)構(gòu)參數(shù)辨識方程組，求 解結(jié)構(gòu)參數(shù)辨識方程組即可得到機器人19的結(jié)構(gòu)參數(shù)、實現(xiàn)機器人19的標(biāo)定。
[0045] 本發(fā)明的有益效果是：
[0046] 1、采用長度可變化的拉線傳感器，從而在采集數(shù)據(jù)時機器人的運動空間變大，機 器人各關(guān)節(jié)的運動更加充分，為結(jié)構(gòu)參數(shù)解算提供了魯棒性更強的數(shù)據(jù)支持同時標(biāo)定操作 更加靈活輕便。
[0047] 2、機器人末端在空間兩點間的距離，可根據(jù)拉線傳感器、角度傳感器I、角度傳感 器Π 的讀數(shù)計算出，提高了結(jié)構(gòu)參數(shù)解算的可靠性和精度。
[0048] 3、由于不需要測出機器人末端的坐標(biāo)值，因此簡化了操作步驟并提高了標(biāo)定效 率。
【附圖說明】
[0049] 圖1是本發(fā)明在標(biāo)定過程中采集數(shù)據(jù)時的位姿圖；
[0050] 圖2是本發(fā)明標(biāo)定裝置結(jié)構(gòu)示意圖；
[0051 ]圖3是本發(fā)明軸承座I與下底板安裝示意圖；
[0052]圖4是本發(fā)明軸承座Π 與上底板安裝示意圖；
[0053]圖5是本發(fā)明深溝球軸承Π 與連接塊安裝示意圖；
[0054]圖6是本發(fā)明機器人末端空間連續(xù)兩點i與j的空間幾何關(guān)系與距離計算原理圖；
[0055] 圖中：1_下底板、2-軸承座1、3_圓錐滾子軸承1、4_阻擋片、5-角度傳感器I、6_旋轉(zhuǎn) 軸I、7-軸承座Π 、8-圓錐滾子軸承Π 、9-支撐柱、10-上底板、11-連接塊、12-旋轉(zhuǎn)軸Π 、13-轉(zhuǎn)向環(huán)、14-角度傳感器Π 、15-深溝球軸承I、16-深溝球軸承Π 、17-拉線傳感器、18-連接 桿、19