線結構光視覺傳感器機器人手眼關系標定

　　摘要：為實現對工業機器人手眼關系的標定，提出一種基于線結構光視覺傳感器的手眼關系標定方法。該方法在標定時，將一個平面靶標作為參考物固定在工業機器人工作空間內，控制工業機器人末端運動以帶動線結構光視覺傳感器作多組變位姿運動，獲取在不同位姿狀態下的平面靶標圖像并對其進行圖像處理。通過對圖像上固定特征點的測量，以及建立線結構光視覺傳感器模型和手眼關系模型實現對線結構光內參數和手眼關系的標定。用棋盤格標定板進行測量實驗驗證，實驗結果表明該方法準確度為0.036mm，即優于40μm，可用于工業機器人的測量應用。

　　關鍵詞：手眼關系;線結構光傳感器;標定;工業機器人

　　《中國工業評論》文稿應資料可靠、數據準確、具有創造性、科學性、實用性。應立論新穎、論據充分、數據可靠，文責自負(嚴禁抄襲)，文字要精煉。

　　0 引言

　　工業機器人廣泛應用在工業制造領域，通常需要將測量傳感器安裝在機器人末端，以獲取被測物的三維信息。因此可將線結構光視覺傳感器安裝于六軸工業機器人末端，構成基于線結構光的機器人視覺測量系統。該系統可通過控制機器人以不同位

　　作者簡介：陸藝(1979-)，男，江蘇揚州市人，副教授，碩士，研究方向為精密檢測技術、汽車零部件自動化測試。姿運動，從而對目標點進行測量獲得測量坐標系與目標點之間位置關系。要實現上述測量過程，需要先對線結構光傳感器內參數和機器人手眼關系進行標定。其中線結構光傳感器內參數標定根據靶標不同分為三維標定[1-2]和二維標定[3]兩種。三維標定靶標具有一定精度，但靶標成本和工藝要求高。二維靶標制作簡單、效率高，標定精度能滿足不同場合的測量需要。手眼關系標定方法通常有有限場景點法[4]，平面靶標法[5-7]，標準球法[8]等。其中手眼關系轉換矩陣的求解可通過兩步分離法[9]或單步法[10-11]得到，單步法可一步得到旋轉向量、平移向量，兩步分離法分兩步得到旋轉向量、平移向量，它存在累積誤差。

　　為此提出基于線結構光視覺傳感器的手眼關系標定的方法。該方法采用二維平面靶標進行標定，并通過單步法求解手眼關系。它簡化工業機器人測量系統的標定過程，僅通過控制機器人末端作位姿運動同時得到攝像機內外參數，線結構光內參數以及手眼關系，保證較高精度。以研華LNC-56000型六軸工業機器人為實驗平臺進行標定和測量實驗，驗證該方法的有效性。

　　1 系統標定原理

　　1.1 線結構光視覺傳感器模型

　　線結構光傳感器數學模型如圖1所示，該傳感器包括CCD相機以及線激光器兩部分。其中被測點尸在圖像坐標系OUV下坐標為(u，v)，在相機坐標系OcXcYcZc下坐標為(xc，yc，zc)，在世界坐標系OwXwYwZw下坐標為(xw，yw，zw)，像面坐標系為OXY，相機主點坐標為(u0，v0)。

　　結合上述模型，根據相機的投影變換模型，被測點尸在圖像坐標系和相機坐標系的關系為式(1)，相機坐標系和世界坐標系的關系為式(2)：其中kx，ky為相機X軸、Y軸放大系數，MC為相機內參數矩陣，CMW為相機坐標和世界坐標轉換關系外參數矩陣，包括旋轉矩陣R和平移矩陣T。

　　假設在相機坐標系下光平面方程表示為：

　　z=Ax+By+C(3)

　　結合式(1)和式(3)，可得到點P在相機坐標下的坐標為：

　　根據以上過程，已知光平面在相機下的方程即可得知空間某一點在相機坐標系下的坐標。式中kx，ky，u0，v0即為需要標定的相機內參數，光平面方程系數A，B，C即為待標定的結構光內參數。

　　1.2 確定線結構光內參數

　　采用如圖2所示的棋盤格標定板作為平面靶標，棋盤格為7×7的方形靶標，棋盤格大小為11mm×11mm。將標定板固定放置在工業機器人工作空間內，控制工業機器人帶動線結構光傳感器不同姿態得到靶標圖像。通過張正友標定法[12]獲得相機內外參數MC，CMW，即kx、ky、u0、v0和靶標坐標系與相機坐標系的轉換矩陣。靶標上角點和激光條形成交點，這些交點都為光平面上的點，將它們作為標定線結構光內參數的標定特征點。由式(2)得到這些特征點在相機坐標系下的坐標。通過使機器人末端帶動線結構光傳感器運動到不同位置，獲取多組標定特征點在相機坐標系下的坐標，由此可擬合相機坐標系下的光平面方程，獲得線結構光內參數A、B、C。

　　1.3 手眼關系模型

　　把線結構光視覺傳感器安裝在工業機器人末端，由此構成機器人視覺測量系統。按照圖3所示建立坐標系，其中Ob為機器人基坐標系，Qw為世界坐標系，Oe為工業機器人末端坐標系，Oc為相機坐標系。

　　由1.1和1.2可知，激光器投射出的光平面與被測物體相交形成光條，根據相機內參數及線結構光傳感器內參數即可得到被測點在相機坐標系下的坐標。控制機器人運動到不同位姿，通過式(5)將被測點的坐標統一到世界坐標系即機器人基坐標系下，便可獲得被測物體三維數據。