基于PMPSD的工業(yè)機器人幾何參數(shù)標定方法

,,

(1.江南大學(xué) 輕工過程先進控制教育部重點實驗室,江蘇 無錫 214122;2.無錫信捷電氣股份有限公司,江蘇 無錫 214072)

0 概述

工業(yè)機器人在眾多領(lǐng)域得到廣泛應(yīng)用,對其定位精度的要求也越來越高。定位精度分為重復(fù)定位精度和絕對定位精度。目前,工業(yè)機器人的絕對定位精度較低,難以滿足高精度行業(yè)(如汽車制造、電子電氣)的生產(chǎn)需求。而機器人的定位誤差可分為幾何誤差和非幾何誤差,其中幾何誤差成為影響工業(yè)機器人定位誤差的主要因素[1-2]。因此,需要利用標定技術(shù)對工業(yè)機器人進行運動學(xué)標定,通過對幾何參數(shù)名義值修正,提升機器人的定位精度。

目前,工業(yè)機器人標定方法主要分為兩大類:機理建模法和測試建模法?；跈C理建模的方法主要是根據(jù)機器人的運動學(xué)特征進行參數(shù)標定,分為微分誤差補償法[3]和關(guān)節(jié)空間補償法[4]。測試建模是依據(jù)機器人輸入和輸出的實測數(shù)據(jù)進行估算建模,分為神經(jīng)網(wǎng)絡(luò)補償法[5-6]和插補補償法[7],又稱黑箱方法。

上述研究多是在基于高精度測量設(shè)備的條件下,對工業(yè)機器人末端位姿進行測量,如激光跟蹤儀[8-9]、機器人測量臂[10]、拉線式機器人測量和性能分析系統(tǒng)[11-12]等。而這些設(shè)備昂貴,并且使用時需要耗費大量的時間進行測量系統(tǒng)與機器人基坐標系之間的坐標變換,對操作人員的水平依賴高,主要適合于實驗室場景下研究。

針對設(shè)備昂貴、操作復(fù)雜等問題,文獻[13-15]提出了在機器人末端施加約束而形成運動學(xué)閉合鏈的方法。這類方法避開了昂貴的設(shè)備,并且不需要建立坐標轉(zhuǎn)換關(guān)系,同樣也避免了坐標轉(zhuǎn)換誤差。文獻[16-17]提出了一種基于位置敏感探測器(Position Sensitive Detector,PSD)的標定方法。但是該方法針對于低精度的工業(yè)機器人很難通過PSD反饋控制[18],將激光束準確地投射到PSD中心,因此不能準確地采用點約束方法構(gòu)建正確的模型約束目標函數(shù),進而不能準確地辨識出工業(yè)機器人的幾何參數(shù)誤差。

針對以上問題,本文提出一種基于位姿修正位置敏感探測器(Pose Modify Position Sensitive Detector,PMPSD)對工業(yè)機器人的參數(shù)誤差進行辨識,修正幾何參數(shù)名義值。以DENSO工業(yè)機器人和PSD裝置為實驗平臺,并利用激光跟蹤儀對所提方法進行實驗驗證。

1 誤差運動學(xué)模型

依據(jù)D-H規(guī)則建立機器人運動學(xué)模型,相鄰兩桿坐標系之間的齊次變換如式(1)所示。

(1)

由于機器人幾何參數(shù)存在誤差,因此需要構(gòu)建誤差運動學(xué)模型,將式(1)改為如式(2)所示的齊次變換形式。

(2)

(3)

2 參數(shù)辨識原理

2.1 PSD原理

PSD是一種基于橫向光電效應(yīng)的位置傳感器件,目前在光學(xué)定位跟蹤、位移距離及角度測量等領(lǐng)域中有著廣泛的應(yīng)用[20]。PSD可分為一維PSD和二維PSD。當入射光投射到二維PSD表面某點,斑點位置離每個電極距離不同時,各電極收集到的電流強度與斑點位置相對應(yīng),光斑位置的計算公式為:

(4)

(5)

其中,Vx1、Vx2、Vy1、Vy2為PSD各電極X1、X2、Y1、Y2的電流經(jīng)過I/V轉(zhuǎn)換后的電壓信號,Lx為X軸感光面長度,Ly為Y軸感光面長度,(X,Y)為光斑重心在PSD表面的二維坐標。二維PSD結(jié)構(gòu)與PSD實物圖如圖1、圖2所示。

圖1 二維PSD結(jié)構(gòu)

圖2 PSD實物圖

2.2 激光束模型

機器人標定系統(tǒng)使用一種基于直線的虛擬點約束(VLBVPC)原理[21]用來辨識幾何參數(shù)誤差,如圖3所示。該方法主要依賴于安裝在機器人末端關(guān)節(jié)上的激光器和PSD裝置。激光器以不同位姿投射激光束于PSD表面中心點,以構(gòu)成點約束關(guān)系。

圖3 多點約束原理

激光器固定安裝在機器人末端關(guān)節(jié)上,因此位置相對末端關(guān)節(jié)是固定的,則有激光束在末端坐標系下的直線方程為:

(6)

其中,(xE,yE,zE)為激光束在機器人末端坐標系下的某一固定坐標,(αE,βE,γE)為激光束在機器人末端坐標系下的方向矢量,因此可以得到激光束在機器人基坐標系下的直線方程為:

(7)

其中:

(8)

記任意一條激光束方程為L(pxi,pyi,pzi,αi,βi,γi),可得任意2條激光束的交點或者公垂線中點[22]。

2.3 位姿修正原理

利用示教器控制方式,將激光束投射到PSD中心,記錄此時的關(guān)節(jié)轉(zhuǎn)角θ1,然后改變機器人位姿,重新將激光束投射到PSD中心,記錄此時的關(guān)節(jié)轉(zhuǎn)角θ2,這時便可得到兩組激光束方程,可求得PSD中心點相對于機器人基坐標系的坐標為Pf(pfx,pfy,pfz)。由于PSD為位置傳感器,因此當激光束再投射到PSD表面時,此時的斑點位置為Ps(psx,psy,psz)。

設(shè)三維空間中任意一條激光束的直線方程表示為L(px,py,pz,α,β,γ),其中,Pt(px,py,pz)為激光器相對于機器人基坐標系的坐標,DVt為在基坐標系下的激光束方向矢量,如圖4所示。由于激光器以不同的位姿將激光束投射到PSD的表面,因此可以得到多組機器人關(guān)節(jié)轉(zhuǎn)角,也就可以獲得多組激光束在機器人基坐標系下的直線方程。PSD表面中心點坐標為Pc(pcx,pcy,pcz),激光束投射在PSD上的斑點位置為Ps(psx,psy,psz),可得投射斑點到PSD中心點的方向矢量為:

sc=Pc-Ps

(9)

已知激光束方向矢量DV及投射斑點至PSD中心點的方向矢量sc,因此可以得到虛擬激光束方向矢量VDVt(α′,β′,γ′)為:

VDVt=DVt+sc

(10)

圖4 位姿修正原理

利用已知激光器坐標Pt(px,py,pz)及得到的虛擬激光束方向矢量VDVt,再運用機器人運動學(xué)逆解求得多組關(guān)節(jié)轉(zhuǎn)角值,并選取其中完全平方差之和最小的一組關(guān)節(jié)轉(zhuǎn)角θ′,將關(guān)節(jié)轉(zhuǎn)角θ′取代之前從機器人示教器或控制器取得的關(guān)節(jié)轉(zhuǎn)角值θ。

2.4 空間多點虛擬約束模型

在空間多點虛擬約束模型中,首先以PSD裝置同一位置處,任意2條激光束的交點或者公垂線中點到該交點平均值的距離作為約束目標函數(shù),構(gòu)建空間單點虛擬約束模型,最后將空間單點虛擬約束模型統(tǒng)一構(gòu)建為空間多點約束模型[16,22],所建立的模型約束目標函數(shù)如式(11)所示。

δ*= argmin

(11)

2.5 優(yōu)化方法

使用LM(Levenberg Marquardt)算法[23]對式(11)不斷進行迭代使得δ*最小化,最終得到幾何參數(shù)誤差Δs=[Δa1Δd1Δα1Δθ1… ΔanΔdnΔαnΔθn]T,Δs為m×1的矩陣,m為待辨識的參數(shù)個數(shù),n為機器人關(guān)節(jié)數(shù)。

3 實驗平臺與方法

3.1 實驗平臺

實驗系統(tǒng)如圖5所示。機器人標定系統(tǒng)包括DENSO VP6242G六自由度工業(yè)機器人、激光器、PSD裝置。實驗的工業(yè)機器人重復(fù)定位精度為±0.02 mm,PSD型號為歐光PSD196-LC,其位置精度為5 μm。

圖5 實驗平臺

DENSO VP6242G工業(yè)機器人的D-H參數(shù)如表1所示。

表1 DENSO VP6242G機器人D-H參數(shù)

3.2 實驗方法

整個實驗過程的流程如圖6所示,主要包含6個部分內(nèi)容。

圖6 幾何參數(shù)標定流程

1)工具坐標系標定

2)PSD裝置數(shù)據(jù)采樣

使用PSD裝置進行數(shù)據(jù)采樣,包括以下步驟:

步驟1將PSD裝置放置在激光束可投射的空間中,機器人以任意姿態(tài)將激光束投射到PSD表面,此時記錄激光束投射在PSD上的斑點位置Ps,i,j,并從機器人示教器或直接從控制器中讀取關(guān)節(jié)轉(zhuǎn)角值。

步驟2改變機器人的位姿,重新將激光束投射到PSD表面,依照步驟1重復(fù)k次,因此可以獲得k組激光束投射在PSD表面的斑點位置Ps,i,j以及k組不同姿態(tài)下的關(guān)節(jié)轉(zhuǎn)角值θi,j。

步驟3重新放置PSD裝置的位置,重復(fù)步驟1～步驟2。在采樣過程中,i=1,2,…,k,j=1,2,…,m,k為同一PSD裝置位置的數(shù)據(jù)采樣次數(shù),m為PSD裝置的位置個數(shù)。

3)位姿及關(guān)節(jié)轉(zhuǎn)角修正

利用空間矢量關(guān)系修正機器人末端激光器的位姿,并利用修正后的位姿對機器人關(guān)節(jié)轉(zhuǎn)角進行修正,以取代PSD裝置數(shù)據(jù)采樣時得到的關(guān)節(jié)轉(zhuǎn)角。

4)模型約束目標函數(shù)構(gòu)建

首先以PSD裝置同一位置處,任意2條激光束的交點或者公垂線中點到該交點平均值的距離作為約束目標函數(shù),構(gòu)建空間單點虛擬約束模型,最后將空間單點虛擬約束模型統(tǒng)一構(gòu)建為空間多點約束模型[16,22],所建立的θ1約束目標函數(shù)如式(11)所示。

5)優(yōu)化算法辨識參數(shù)誤差

使用LM算法對所構(gòu)建的模型約束目標函數(shù)進行優(yōu)化處理,當?shù)諗繒r,得到工業(yè)機器人的參數(shù)誤差。

6)幾何參數(shù)名義值修正

將辨識得到的參數(shù)誤差對幾何參數(shù)名義值進行修正,然后結(jié)合LEICA激光跟蹤儀進行測量驗證。

4 實驗結(jié)果與分析

采用PSD進行數(shù)據(jù)采集前,首先需要對工具坐標系進行標定,依據(jù)文獻[19]的方法,得到的激光發(fā)射器相對于機器人末端坐標系的齊次變換矩陣為:

為了辨識工業(yè)機器人的幾何參數(shù)誤差,實驗將PSD裝置放置在3個不同的位置,并采用不同位姿將激光束投射到PSD表面,在每個PSD裝置的位置依次采集10組數(shù)據(jù),如表2～表4所示。

表2 位置1處10組關(guān)節(jié)轉(zhuǎn)角值 (°)

表3 位置2處10組關(guān)節(jié)轉(zhuǎn)角值 (°)

表4 位置3處10組關(guān)節(jié)轉(zhuǎn)角值 (°)

利用本文提出的方法對位姿及關(guān)節(jié)轉(zhuǎn)角進行修正,修正后的關(guān)節(jié)轉(zhuǎn)角值如表5～表7所示。

表5 位置1處修正的關(guān)節(jié)轉(zhuǎn)角值 (°)

表6 位置2處修正的關(guān)節(jié)轉(zhuǎn)角值 (°)

表7 位置3處修正的關(guān)節(jié)轉(zhuǎn)角值 (°)

根據(jù)激光束模型得到修正后每條激光束之間的交點,然后求得該處位置下交點的均值交點。經(jīng)過數(shù)據(jù)處理,求得位置1、位置2、位置3下的均值交點分別為(466.560 6,-148.848 4,16.248 9)、(476.197 7,70.481 6,21.478 2)、(478.444 0,269.381 3,23.647 2)。

通過構(gòu)建模型約束目標函數(shù),最終利用LM算法進行最小化處理。當算法收斂穩(wěn)定時,得到如表8所示的機器人D-H參數(shù)誤差。

表8 辨識出的機器人D-H參數(shù)誤差

得到機器人的幾何參數(shù)誤差后,對幾何參數(shù)名義值進行補償修正。使用LEICA激光跟蹤儀測量得到補償前后的位置誤差,并以最大誤差、平均誤差、標準差作為評價指標[24]。從表9中可以看出本文方法進行機器人幾何參數(shù)修正的有效性。

表9 本文方法標定結(jié)果比較 mm

標定前的位置誤差最大值為1.962 9 mm,平均誤差為1.850 5 mm,標準差為1.852 1 mm,利用所提的方法對機器人參數(shù)名義值進行補償后的位置誤差最大值為0.664 2 mm,平均誤差為0.401 9 mm,標準差為0.437 4 mm,平均誤差改善了78.28%,標準差改善了76.38%。

本文針對由幾何因素引起的絕對定位精度問題進行補償,而其他一些非幾何因素,如溫度、齒輪間隙、機器人自重引起的桿件彈性變形等,這些不能通過機理建模進行補償,需要通過建立非線性模型進行分析,也就是需要采用測試建模的方法對機器人的定位精度進行補償。

5 結(jié)束語

針對由幾何因素引起的機器人絕對定位精度低的問題,提出一種基于PMPSD的方法對工業(yè)機器人的參數(shù)誤差進行辨識研究。該方法避免了采用PSD反饋控制的策略及坐標變換帶來的誤差問題,并利用激光跟蹤儀進行驗證,能夠快速實現(xiàn)工業(yè)機器人幾何參數(shù)標定。通過對幾何參數(shù)名義值進行有效修正,使得補償后的模型更接近于實際模型,明顯提高了機器人的定位精度。本文主要考慮由幾何因素引起的機器人定位精度問題,下一步將圍繞非幾何因素(如溫度、連桿柔性等)進行研究。

[1] LIM H K,KIM D H,KIM S R,et al.A Practical Approach to Enhance Positioning Accuracy for Industrial Robots[C]//Proceedings of ICCAS’09.Washington D.C.,USA:IEEE Press,2009:2268-2273.

[2] 李 睿,曲興華.基于組合測量的機器人運動誤差特性分析及定位補償技術(shù)[J].機器人,2014,36(3):279-284.

[3] ZHANG J Y,ZHAO C,ZHANG D W.Pose Accuracy Analysis of Robot Manipulators Based on Kinematics[J].Advanced Materials Research,2011(201-203):1867-1872.

[4] 洪 鵬,田 威,梅東棋,等.空間網(wǎng)格化的機器人變參數(shù)精度補償技術(shù)[J].機器人,2015,37(3):327-335.

[5] ANGELIDIS A,VOSNIAKOS G C.Prediction and Compensation of Relative Position Error Along Industrial Robot End-effector Paths[J].International Journal of Precision Engineering Manufacturing,2014,15(1):63-73.

[6] 周 煒,廖文和,田 威,等.基于粒子群優(yōu)化神經(jīng)網(wǎng)絡(luò)的機器人精度補償方法研究[J].中國機械工程,2013,24(2):174-179.

[7] BAI Y,WAN D.On the Comparison of Fuzzy Interpolation and Other Interpolation Methods in High Accuracy Measurements[C]//Proceedings of IEEE International Conference on Fuzzy Systems.Washington D.C.,USA:IEEE Press,2010:1-7.

[8] NGUYEN H N,ZHOU J,KANG H J.A Calibration Method for Enhancing Robot Accuracy Through Integration of an Extended Kalman Filter Algorithm and an Artificial Neural Network[J].Neurocomputing,2015,151(1):996-1005.

[9] JOUBIR A,NUBIOLA A,BONEV I.Calibration Efficiency Analysis Based on Five Observability Indices and Two Calibration Models for a Six-Axis Industrial Robot[J].Sae International Journal of Aerospace,2013,6(1):161-168.

[10] WANG W,LIU F,YUN C.Calibration Method of Robot Base Frame Using Unit Quaternion Form[J].Precision Engineering,2015,41(3):47-54.

[11] ASENSIO J,CHEN W,TOMIZUKA M,et al.Feedforward Input Generation Based on Neural Network Prediction in Multi-joint Robots[J].Journal of Dynamic Systems Measurement and Control,2014,136(3):833-846.

[12] MESSAY T,ORDONEZ R,MARCIL E.Computationally Efficient and Robust Kinematic Calibration Methodologies and Their Application to Industrial Robots[J].Robotics and Computer-integrated Manufacturing,2016,37(3):33-48.

[13] JOUBAIR A,BONEV I A.Kinematic Calibration of a Six-axis Serial Robot Using Distance and Sphere Constraints[J].The International Journal of Advanced Manufacturing Technology,2015,77(1):515-523.

[14] WANG W,LI A,WU D.Robot Calibration by Observing a Virtual Fixed Point[C]//Proceedings of 2009 IEEE International Conference on Robotics and Biomimetics.Washington D.C.,USA:IEEE Press,2009:1351-1355.

[15] HU J S,WANG J J,CHANG Y J.Kinematic Calibration of Manipulator Using Single Laser Pointer[C]//Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems.Washington D.C.,USA:IEEE Press,2012:426-430.

[16] LIU Y,SHI D,DING J.An Automated Method to Calibrate Industrial Robot Kinematic Parameters Using Spherical Surface Constraint Approach[C]//Proceedings of IEEE International Conference on Cyber Technology in Automation,Control,and Intelligent Systems.Washington D.C.,USA:IEEE Press,2014:154-165.

[17] DU S,DING J,LIU Y.Industrial Robot Kinematic Calibration Using Virtual Lne-based Sphere Surface Constraint Approach[C]//Proceedings of 2015 IEEE International Conference on Cyber Technology in Automation,Control,and Intelligent Systems.Washington D.C.,USA:IEEE Press,2015:48-53.

[18] LIU Yong,XI Ning,SHEN Yantao.High-accuracy Positioning of an Industrial Robot Using Image/PSD-based Hybrid Servo Control[J].International Journal of Optomechatronics,2011,5(2):170-187.

[19] 張文增,陳 強,孫振國,等.弧焊機器人工件坐標系快速標定方法[J].焊接學(xué)報,2005,26(7):1-4.

[20] 賈天祥,徐熙平,董文博.二維位置敏感探測器自動測試系統(tǒng)[J].儀表技術(shù)與傳感器,2012(10):67-69.

[21] LIU Y,XI N,ZHANG G,et al.An Automated Method to Calibrate Industrial Robot Joint Offset Using Virtual Line-based Single-point Constraint Approach[C]//Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems.Washington D.C.,USA:IEEE Press,2009:715-720.

[22] 周 祥.工業(yè)機器人工具及工件坐標系的標定研究[D].南京:南京理工大學(xué),2015.

[23] MADSEN K,NIELSEN H B,TINGLEFF O.Methods for Non-linear Least Squares Problems[EB/OL].(2004-10-21).http://www2.imm.dtu.dk/pubdb/views/edoc_download.php/3215/pdf/imm3215.pdf.

[24] 蔡錦達,張劍皓,秦緒祥.六軸工業(yè)機器人的參數(shù)辨識方法[J].控制工程,2013,20(5):805-808.