張　旭　鄭澤龍

1.上海大學(xué)，上海，200072　　2.上海市智能制造及機(jī)器人重點實驗室，上海，200072

?

主動光立體標(biāo)靶檢測及其在工業(yè)機(jī)器人位姿測量中的應(yīng)用

張旭1,2鄭澤龍1

1.上海大學(xué)，上海，2000722.上海市智能制造及機(jī)器人重點實驗室，上海，200072

基于工業(yè)機(jī)器人位姿視覺測量方法提出了用主動光立體標(biāo)靶進(jìn)行機(jī)器人末端位姿測量的方法。以主動紅外光代替反光標(biāo)志點，以主動光圖案特征代替亮度特征作為表達(dá)位置信息的形式，設(shè)計了六面體主動光標(biāo)靶。通過合理設(shè)置特征面圖案，使立體標(biāo)靶特征面提供蘊(yùn)含空間幾何約束的信息，并在此基礎(chǔ)上設(shè)計了特征面識別算法。在室內(nèi)環(huán)境、室外環(huán)境、混合光環(huán)境等實驗條件下，該算法可實現(xiàn)對主動標(biāo)靶健壯的識別和定位。在高精度四軸移動平臺上的測量誤差評價實驗表明：運(yùn)用該標(biāo)靶的立體視覺系統(tǒng)在0.5～3 m工作范圍內(nèi)平均位置誤差為0.0857 mm，平均姿態(tài)誤差為0.1086°，滿足機(jī)器人位姿測量的要求。最后在YASKAWA的Motoman-MH80六軸機(jī)械臂上進(jìn)行了機(jī)器人末端位姿的測量實驗，驗證了該方法的可行性和高效性。

機(jī)器人位姿測量；視覺測量；特征識別；主動光立體標(biāo)靶

0　引言

機(jī)器人位姿測量指的是測量機(jī)器人末端(特指機(jī)器人的末端法蘭中心)相對于測量坐標(biāo)系或機(jī)器人基座坐標(biāo)系的位置和姿態(tài)。獲取機(jī)器人測量位姿對機(jī)器人有著重要的意義。如在用視覺伺服控制機(jī)器人進(jìn)行裝配時需要視覺系統(tǒng)實時反饋機(jī)器人的位姿，從而控制機(jī)器人進(jìn)行裝配[1]；再比如對工業(yè)機(jī)器人D-H參數(shù)標(biāo)定時關(guān)鍵一步就是要獲得多組機(jī)器人的測量位姿，從而進(jìn)行標(biāo)定工作[2-4]?，F(xiàn)今獲取機(jī)器人測量位姿的方法很多，常用的測量方法可以簡單分為接觸式和非接觸式。

接觸式測量方式要求測量設(shè)備必須直接與測量目標(biāo)接觸，如球桿儀[5]、拉線式傳感器[6]等設(shè)備，但通常情況下，這種接觸式的測量在機(jī)械臂上實施起來難度大，操作也較為復(fù)雜且測量范圍較小。非接觸式測量有激光、超聲波、紅外和視覺傳感以及多種方法融合的測量技術(shù)，激光跟蹤儀是較為常用的測量設(shè)備[7]，激光跟蹤儀具有測量精度高、測量范圍大等優(yōu)點，但缺點也很明顯，即不方便搬運(yùn)、價格昂貴。在滿足所需精度的情況下，測量的效率和成本是機(jī)器人末端姿態(tài)測量必須考慮的問題，因此，視覺檢測成為較為常用的非接觸測量方式。視覺測量方法需要在機(jī)器人上安裝特定的視覺標(biāo)靶，常用的標(biāo)靶類型有平面標(biāo)定板[8-9]或表面具有反光標(biāo)記點的標(biāo)靶[10-11]。選用平面視覺標(biāo)定板作為標(biāo)靶的方式不具有實時性，一般都需要先拍完圖片再通過手動選擇感興趣區(qū)域(ROI)的方式才能獲取位姿，獲取效率低，同時因為只有一個面，所以測量的范圍較為有限；而用反光標(biāo)記點的標(biāo)靶，雖然可以做到實時獲取位姿，但反光標(biāo)記點在實際使用中反射效果受工作距離的影響較大，并且需要從復(fù)雜的環(huán)境光中提取特征圓，使得特征圓的檢測更加復(fù)雜，穩(wěn)定性也較差，特別是在有較多鏡面反射或強(qiáng)光現(xiàn)場尤為明顯。

綜合考慮以上測量方法的優(yōu)勢和不足，本文提出了一種用主動光立體標(biāo)靶測量機(jī)器人末端位姿的方法。所用主動光立體標(biāo)靶是利用紅外光提供可供識別的光源圖形，通過相應(yīng)的特征識別算法識別特征圖形以獲取立體標(biāo)靶在測量坐標(biāo)系下的測量位姿，繼而通過位姿變換獲得機(jī)器人末端位姿。該方法只要獲取安裝在機(jī)器人末端的立體標(biāo)靶的圖片便能立即獲得機(jī)器人的末端姿態(tài)，操作方便，測量效率高，同時具有較高的測量精度。

1　主動光立體標(biāo)靶及其視覺檢測算法

1.1主動光立體標(biāo)靶

工業(yè)機(jī)器人的工作范圍較大，要求所設(shè)計的立體標(biāo)靶在機(jī)器人運(yùn)動范圍內(nèi)各個角度都能可視，所以本文的立體標(biāo)靶為六面體結(jié)構(gòu)，其中標(biāo)靶的多個面上都提供了可供識別的特征圓的組合圖形(立體標(biāo)靶上有特征圖形的面以下簡稱特征面)。

為了提供位姿信息，特征面上的特征圖形設(shè)計成由7個大圓、3個小圓組成的組合圖形，如圖1所示。其中7個大圓作為特征圓，用來構(gòu)建標(biāo)靶特征面的固連坐標(biāo)系，3個小圓作為輔助識別特征(圖1b)。立體標(biāo)靶的每個特征面上都定義了對應(yīng)的固連坐標(biāo)系，這里統(tǒng)一說明：1號大圓的圓心為坐標(biāo)系的原點，1號大圓到3號大圓的向量為X軸，1號大圓到5號大圓的向量為Y軸。

(a)整體機(jī)構(gòu)

(b)特征圖形

(c)四層均勻光結(jié)構(gòu)圖1　主動光立體標(biāo)靶

標(biāo)靶的每個特征面上都有可供識別的特征圖形，所以其上的特征圖形除了攜帶位姿信息外同時還應(yīng)攜帶所在特征面的面編號信息，以區(qū)別不同的特征面，如圖1b所示，用c號小圓相對7號大圓的位置關(guān)系來提供標(biāo)靶的面編號信息，圖中c號小圓的5個位置分別代表了5個特征面(為了方便表述，下文用FAC_i (i=1,2，…，5)表示立體標(biāo)靶的第i號特征面)。通過這種方式，立體標(biāo)靶的每個特征面便能提供位姿信息和面編號信息。

在用主動光產(chǎn)生特征圓的過程中，光源亮度不均將直接導(dǎo)致特征檢測精度下降，為此本文提出用圖1c所示的四層的結(jié)構(gòu)來解決光源成像不均的問題。四層結(jié)構(gòu)從下到上依次為：光源層、隔離層、擴(kuò)散層和修光層。光源層用于提供紅外光源，光源選用波長為850nm、發(fā)光角度為120°的紅外LED燈珠；隔離層用于隔離燈珠，擴(kuò)大燈珠的發(fā)光角度；擴(kuò)散層為光擴(kuò)散板，光擴(kuò)散板可通過化學(xué)和物理的手段，利用光線在行進(jìn)途中遇到兩個折射率相異的介質(zhì)時，發(fā)生折射、反射與散射的物理現(xiàn)象，實現(xiàn)入射光充分散色，以此產(chǎn)生光學(xué)擴(kuò)散的效果，使光源均勻；修光層為有較高加工精度的金屬薄片，在其上用激光雕刻的方法雕刻出標(biāo)靶的特征圖形，然后將其覆蓋在擴(kuò)散板上以獲得所需要的特征圖形。

如上所述立體標(biāo)靶的最終結(jié)構(gòu)如圖1a所示，其中5個面為特征面，每個特征面都是圖1c所示的四層結(jié)構(gòu)，另外一個面用于連接機(jī)器人和固定LED供電電路。

通過在相機(jī)鏡頭前加裝帶通為850nm的濾波片，在室內(nèi)環(huán)境下可以將大部分環(huán)境干擾濾除，圖2所示即為標(biāo)靶實物的成像效果，可以看出特征圓的亮度十分均勻且形狀規(guī)整。

圖2　立體標(biāo)靶的成像效果

1.2標(biāo)靶特征面檢測算法

用視覺測量的方法獲取標(biāo)靶位姿時，必須對立體標(biāo)靶上用于提供位姿信息的特征面進(jìn)行檢測識別，檢測算法流程如下。

(1)圖像預(yù)處理。圖像預(yù)處理主要進(jìn)行圖像濾波和圖像二值化，用高斯濾波的方式濾除圖像噪點。立體標(biāo)靶的紅外光強(qiáng)大于環(huán)境中的850nm輻射光強(qiáng)，主動光斑相對環(huán)境具有較大的對比度，設(shè)定閾值對圖像進(jìn)行二值化以分離目標(biāo)和背景。

(2)特征圓提取。為了從環(huán)境中準(zhǔn)確獲取目標(biāo)特征圓，濾除環(huán)境光干擾，以提高后期進(jìn)行特征圓識別的效率和準(zhǔn)確率，就必須對圖像的輪廓特征進(jìn)行過濾。這里采用三個過濾條件：①輪廓所占像素數(shù)。特征圓在測量范圍內(nèi)其輪廓長度為有限值，而非巨大背景或散亂噪聲產(chǎn)生的輪廓。②輪廓長短軸比值。圓特征經(jīng)過透視投影，在攝像機(jī)上成像為橢圓，輪廓經(jīng)橢圓擬合后可獲得橢圓長軸、半軸，計算長短軸比值并同設(shè)定的閾值比較，濾除傾斜角度過大的特征圓。③橢圓面積。根據(jù)擬合后的橢圓面積和原輪廓所占像素數(shù)的差值濾除非橢圓特征的環(huán)境干擾。具體流程如圖3所示。

圖3　特征圓提取、篩選過程

(3)確定特征圓標(biāo)號。①查找1號大圓。根據(jù)1號大圓和兩個環(huán)繞小圓的尺寸位置約束(圖1b)，可找出1號大圓。②查找a號、b號小圓，確定參考方向向量。為了找出其他的大圓，需先定義三個參考方向：X、Y軸方向和45°方向。這里用1號大圓的兩個環(huán)繞小圓定義參考向量，所以先要辨識這兩個環(huán)繞小圓。建立1號大圓到兩小圓的矢量，分別用V1=(x1,y1,0)和V2=(x2,y2,0)表示。由圖1b可知a號小圓位于-X軸方向，b號小圓位于Y軸方向，將V1和V2叉乘，以叉乘后的向量的z值的正負(fù)來辨識a號、b號小圓。識別出a號、b號小圓后，分別求從1號大圓圓心到a號小圓圓心、從1號大圓圓心到b號小圓圓心、a號小圓圓心到b號小圓圓心的矢量作為參考方向，即X、Y軸方向和45°方向，分別用Vx、Vy、V45表示。③查找2～7號大圓，更新參考方向向量。根據(jù)上一步定義的Vx、Vy、V45分別找出在這些方向向量上的圓，并根據(jù)其同1號大圓的距離關(guān)系確定編號。這樣可識別出每個方向上各有三個大圓，用最小二乘法將三個方向上的大圓圓心分別擬合成直線，作為新的方向向量，更新Vx、Vy、V45方向參考向量。④查找c號小圓，確定面編號。根據(jù)標(biāo)記號為7的大圓及其小圓特征點距離約束，識別標(biāo)記號為7的大圓的環(huán)繞小圓點，并計算標(biāo)記號為7的大圓到小圓點的方向Vc，將Vc分別與Vx、Vy、V45進(jìn)行叉乘，然后找出叉乘所得向量的z值最小的向量，以此來判斷同Vc共線或接近共線的向量，再將兩個向量點乘，判斷兩向量是同向還是反向，從而確定該組特征點所在面。

通過以上檢測算法，立體標(biāo)靶在各種環(huán)境中都能取得較高的檢測效率和穩(wěn)定性，圖4所示為標(biāo)靶實際檢測效果。

(a)室內(nèi)環(huán)境下的檢測效果

(b)室外環(huán)境下的檢測效果圖4　標(biāo)靶檢測算法的檢測效果

1.3機(jī)器人位姿測量方法

機(jī)器人末端的位姿信息包括了旋轉(zhuǎn)和平移。所以這里用4×4的齊次矩陣A來描述位姿信息，如下式所示：

(1)

式中，R為3×3的矩陣，表示位姿的旋轉(zhuǎn)量；T為3×1的矩陣，表示位姿的平移量。

在雙目立體視覺測量中，當(dāng)已知空間中某點在左右相機(jī)圖像中的對應(yīng)點時就可以確定該點在相機(jī)測量坐標(biāo)系下的三維信息。通過標(biāo)靶特征檢測算法識別出左右相機(jī)圖片上的特征圓后，根據(jù)特征圓標(biāo)號信息確定對應(yīng)性，便可得到立體標(biāo)靶上的特征圓圓心的三維信息，用Pi=(xi,yi,zi)T來表示第i號特征圓圓心在雙目系統(tǒng)坐標(biāo)系下的三維坐標(biāo)，用a1、a2分別表示從1號特征圓圓心到3號特征圓圓心和從1號特征圓圓心到5號特征圓圓心的向量，則有

(2)

對a1、a2兩向量單位正交化，有

(3)

定義β1、β2分別為標(biāo)靶特征面坐標(biāo)系的X、Y軸，所以Z軸 β3=β1?β2?？傻脴?biāo)靶特征面坐標(biāo)系在測量位姿的旋量R=[β1β2β3]，平移量T=P1，由此可得標(biāo)靶特征面的測量位姿為

(4)

(5)

立體標(biāo)靶有多個特征面，所以可能會出現(xiàn)多個特征面同時出現(xiàn)在相機(jī)視野中，此時，標(biāo)靶識別算法會進(jìn)行特征面判斷，如果能識別到FAC_1，則不對其他特征面做位姿計算；如果無FAC_1，則對出現(xiàn)在視野中的特征面求位姿并通過式(5)分別轉(zhuǎn)化成FAC_1的位姿，然后對獲得的多個FAC_1的位姿求平均作為FAC_1的位姿。

(6)

(a)測量中的位姿傳遞關(guān)系(b)位姿傳遞鏈簡圖圖5　位姿傳遞關(guān)系

2　立體標(biāo)靶的標(biāo)定和檢測算法的魯棒性分析

2.1立體標(biāo)靶特征檢測算法的魯棒性分析

根據(jù)1.2節(jié)的標(biāo)靶檢測方法編寫算法并進(jìn)行算法魯棒性實驗。分別在室內(nèi)環(huán)境、室外環(huán)境、混合光源環(huán)境(在室外環(huán)境中加入人工光源干擾)下進(jìn)行實驗。將標(biāo)靶放置在離相機(jī)0.5～3 m的工作距離內(nèi)，每隔0.5 m拍攝100張樣張進(jìn)行識別統(tǒng)計，以測試標(biāo)靶識別算法在不同環(huán)境不同測量距離下的識別效果，得到的識別結(jié)果如圖6所示，可以看出：在室內(nèi)環(huán)境中，在工作距離內(nèi)識別率基本都能達(dá)到100%，平均識別率為98.1%；在室外和混合光的環(huán)境下識別率有所下降，平均識別率分別為89.33%和88.00%，這是因為室外光和混合光的實驗環(huán)境是選擇在有強(qiáng)太陽光直射的場地進(jìn)行的，而實際的機(jī)器人測量基本都是室內(nèi)進(jìn)行的，室外環(huán)境下的實驗只作為算法魯棒性評價之用，在實際測量中并無實際參考價值。室內(nèi)環(huán)境下在0.5～3 m的測量范圍內(nèi)98.1%的識別率證明了識別算法具有較高的魯棒性，符合實際測量要求。

圖6　立體標(biāo)靶識別算法在不同測量距離和不同測量環(huán)境下的識別率

2.2立體標(biāo)靶的標(biāo)定

如上文所述，要對標(biāo)靶進(jìn)行檢測需先知道標(biāo)靶特征面在FAC_1坐標(biāo)系下的位姿，標(biāo)靶的這些參數(shù)在設(shè)計標(biāo)靶時便已確定，但由于標(biāo)靶在制作過程中存在加工誤差和裝配誤差，所以在使用立體標(biāo)靶前需要對其進(jìn)行特征面相互位姿關(guān)系的標(biāo)定。隨著攝影測量技術(shù)的發(fā)展，攝影測量的精度已經(jīng)基本能滿足一般的精度測量要求，所以本文采用雙目測量的方法對立體標(biāo)靶的特征面相互位姿關(guān)系進(jìn)行標(biāo)定。

2.2.1雙目立體視覺系統(tǒng)的標(biāo)定

用雙目視覺測量的方法對標(biāo)靶的參數(shù)進(jìn)行標(biāo)定前，需對雙目系統(tǒng)進(jìn)行標(biāo)定。雙目測量系統(tǒng)的標(biāo)定包括每個相機(jī)內(nèi)參數(shù)的標(biāo)定以及兩相機(jī)相對位姿的標(biāo)定(或稱相機(jī)外參數(shù)標(biāo)定)。相機(jī)標(biāo)定技術(shù)已經(jīng)相當(dāng)成熟，主要以Tsai[13]的兩步法和張正友[14]的平面標(biāo)定法為代表，本文采用張正友的標(biāo)定方法進(jìn)行相機(jī)標(biāo)定。相機(jī)標(biāo)定過程中一個關(guān)鍵步驟是選用標(biāo)定板，通常的做法是將標(biāo)定圖片打印出來，貼到表面光潔度和平面度較好的平板上，如圖7a所示，這種方法標(biāo)靶的精度并不高。為了保證標(biāo)定精度，本文采用LCD屏幕顯示的標(biāo)靶(圖7b)，用LCD屏幕產(chǎn)生標(biāo)定圖片的精度能得到較好的保證[15]。

(a)打印的標(biāo)定板　　　(b)用LCD顯示屏顯示標(biāo)定圖片圖7　標(biāo)定板的選用

(7)

即

(8)

根據(jù)式(8)求得的Bi可計算出特征圓之間距離，將其同標(biāo)準(zhǔn)距離比較，從而確定雙目測量系統(tǒng)在不同距離的測量誤差。因為LCD的制作精度已能達(dá)到0.05 μm[15]，所以可以認(rèn)為用屏幕顯示的標(biāo)靶特征圓的相互位置就是標(biāo)準(zhǔn)值。因此用相機(jī)測量出的特征圓的相互位置與LCD屏幕顯示的特征圓的真實相互位置之差便可認(rèn)為是雙目測量系統(tǒng)的測量誤差。圖8所示為通過這種方法得到的相機(jī)在不同距離下的測量誤差。在0.5～3 m的工作范圍內(nèi)整體平均誤差為0.0728 mm，從圖8的曲線可看出標(biāo)定后的測量系統(tǒng)具有較高的測量精度和穩(wěn)定性。

圖8　雙目系統(tǒng)在不同測量距離下的測量精度

2.2.2立體標(biāo)靶特征面相互位姿關(guān)系的標(biāo)定

為了標(biāo)定這些變換矩陣，要求左右相機(jī)的圖像中必須都能清晰地呈現(xiàn)兩個待標(biāo)定的特征面。為了保證標(biāo)定精度，畫面中特征面的法向與相機(jī)的Z向夾角不能過大(小于60°)。例如：如果要標(biāo)定1號特征面和2號特征面的變換關(guān)系，必須保證在左右相機(jī)中都能同時檢測到這兩個特征面，如圖9所示。按上述要求分別獲取所要標(biāo)定面的標(biāo)定圖片。

(a)左相機(jī)圖片　　　　(b)右相機(jī)圖片圖9　標(biāo)定標(biāo)靶特征面相對位姿關(guān)系標(biāo)定圖片

通過雙目測量的方法獲得標(biāo)定圖片上特征圓圓心在相機(jī)坐標(biāo)系下的坐標(biāo)值后，繼而獲得其所在特征面在相機(jī)坐標(biāo)系下的位姿矩陣，它可表示為

(9)

(10)

將式(9)代入式(10)可計算出標(biāo)靶其他特征面在FAC_1坐標(biāo)系下的位姿矩陣，最終標(biāo)定結(jié)果如表1所示。

表1　特征面相對位姿關(guān)系標(biāo)定結(jié)果

注：矩陣中前3×3中的數(shù)值為角度，單位為rad；最后1列的前3個值為位移，單位為mm。

3　機(jī)器人位姿測量實驗

3.1立體標(biāo)靶位姿測量誤差評價實驗

用標(biāo)靶進(jìn)行實際測量前，需要對標(biāo)靶的位姿的測量誤差進(jìn)行評價，本文在高精度的四軸移動平臺上進(jìn)行立體標(biāo)靶的位姿測量誤差評價實驗(圖10)，所用移動平臺為ZOLIX的四軸移動平臺，位姿精度可達(dá)0.01 mm。將測量系統(tǒng)分別置于離移動平臺0.5 m，1 m、1.5 m、2 m、2.5 m、3 m工作距離處，將標(biāo)靶特征面固定在移動平臺上，在每個測量距離處讓平臺移動50次固定值并獲取每次移動的標(biāo)靶圖片，獲得標(biāo)靶的位置信息，將獲得的位置同前一次的測量結(jié)果求相對位姿，便可得到相鄰兩次測量的標(biāo)靶在測量坐標(biāo)系下的位置的改變量(即通過測量系統(tǒng)獲得工作臺的每次移動的移動量)，將這個值同移動臺固定的移動距離5 mm進(jìn)行比較得兩個距離的差。50次的測量可以得到50個差值，對這些差值求平均值，作為評價立體視覺系統(tǒng)在此測量深度下的測量誤差的指標(biāo)。移動雙目系統(tǒng)到下一個測量位置，進(jìn)行同樣的操作，從而可獲得不同測量深度下的測量誤差。采用同樣的方法，讓移動平臺在每個位置處旋轉(zhuǎn)固定角度，得其測量的姿態(tài)誤差，由上述實驗可評估該方法在不同的測量距離下獲取機(jī)器人末端姿態(tài)的誤差，如表2所示。由表2中的數(shù)據(jù)可得在0.5～3 m的工作范圍內(nèi)，立體標(biāo)靶實際測量中的平均的位置誤差為0.0857 mm，平均姿態(tài)誤差為0.1086°，滿足機(jī)器人位姿測量的要求。

圖10　立體標(biāo)靶位姿獲取精度評價實驗現(xiàn)場

測量距離(m)0.51.01.52.02.53.0平均位置誤差(mm)0.03160.03490.06150.09610.12520.1649位置標(biāo)準(zhǔn)差(mm)0.01630.02170.03070.04180.09450.1127平均姿態(tài)誤差(°)0.03270.05260.07720.10030.13960.2494姿態(tài)標(biāo)準(zhǔn)差(°)0.01470.03610.04830.05410.08370.1542

3.2末端位姿測量實驗

為了驗證用主動光立體標(biāo)靶獲取工業(yè)機(jī)器人測量位姿方法的可行性和效率，我們在安川的Motoman_MH80六軸機(jī)械臂上進(jìn)行了機(jī)器人位姿獲取實驗，將主動光立體標(biāo)靶安裝在機(jī)械手臂的末端法蘭上，將測量系統(tǒng)置于離基座3 m處進(jìn)行測量，實驗現(xiàn)場如圖11所示。控制機(jī)械臂繞任意軸走一個空間圓軌跡，測量系統(tǒng)每隔適當(dāng)角度獲取標(biāo)靶圖片，并進(jìn)行特征檢測，獲得立體標(biāo)靶的位姿，再通過手眼標(biāo)定的結(jié)果進(jìn)行位姿變換，繼而得到機(jī)械臂的末端執(zhí)行器的測量位姿,將其與機(jī)械臂的指令位姿進(jìn)行對比。本次實驗中，機(jī)械臂末端執(zhí)行器的測量位姿與指令位姿的最大距離偏差為4.2721 mm，平均距離偏差為2.6905 mm。這是由于機(jī)械臂的絕對定位精度較低造成的，一般未經(jīng)標(biāo)定的工業(yè)機(jī)器人的絕對精度只能維持在2～3 mm水平[16]。由此可見本文測量方法能夠準(zhǔn)確地獲取機(jī)械臂末端的測量姿態(tài)，為機(jī)器人的標(biāo)定或通過視覺伺服引導(dǎo)機(jī)器人進(jìn)行精密裝配等工作提供有力的支持。同時，實驗過程中，該方法在獲得機(jī)器人末端位姿時，獲取標(biāo)靶圖片后便能馬上獲得機(jī)器人的末端位姿，具有很高的測量效率，所以該方法也可用于機(jī)器人的實時軌跡跟蹤。

圖11　六軸機(jī)械臂末端位姿測量實驗現(xiàn)場

4　結(jié)論

(1)提出了一種用主動光立體標(biāo)靶獲取工業(yè)機(jī)器人末端的測量位姿的方法，所用主動光立體標(biāo)靶通過四層均光結(jié)構(gòu)可以獲得亮度均勻、特征圖形準(zhǔn)確的光源特征的六面體視覺標(biāo)靶，通過特定的檢測算法可以在多種工作環(huán)境中對立體標(biāo)靶進(jìn)行準(zhǔn)確識別和定位。

(2)在室內(nèi)測量環(huán)境中，在0.5～3m的工作距離內(nèi)識別成功率可達(dá)到98.1%，即便在有較強(qiáng)環(huán)境干擾的室外環(huán)境和混合光源環(huán)境下也能達(dá)到89.33%和88.00%的識別率。

(3)為了避免立體標(biāo)靶的機(jī)加工和裝配產(chǎn)生的誤差對姿態(tài)測量的影響，用雙目測量系統(tǒng)對立體標(biāo)靶特征面的位姿關(guān)系進(jìn)行了標(biāo)定。

(4)測量精度是該方法是否切實可行的一個重要指標(biāo)，本文通過實驗評價了該方法在實際的位姿測量中的測量精度，得到該方法在0.5～3m的測量范圍內(nèi)測量的平均位置誤差為0.0857mm，平均姿態(tài)誤差為0.1086°，可以滿足機(jī)器人位姿測量的要求。

(5)在六軸機(jī)械臂上的位姿獲取實驗中，得到該測量方法不僅可以準(zhǔn)確獲取機(jī)械臂的姿態(tài)，同時具有較高的測量效率的結(jié)論，因此除了用其進(jìn)行機(jī)器人的標(biāo)定或通過視覺伺服引導(dǎo)機(jī)器人進(jìn)行精密裝配等工作外也可以進(jìn)行機(jī)器人的實時軌跡追蹤。當(dāng)然該方法有其局限性，對于視覺測量方法，測量精度會隨著測量距離的增大而變差，所以該方法用于大行程的機(jī)械臂(臂展超過2m的機(jī)械臂)的測量并不合適，同時測量精度仍有提高的空間，這取決于相機(jī)的標(biāo)定精度和標(biāo)靶的標(biāo)定精度。后期工作中，將進(jìn)一步提高該測量方法的測量精度并將其應(yīng)用在機(jī)器人的標(biāo)定和軌跡跟蹤中。

[1]張建中, 何永義, 李軍. 機(jī)器人裝配視覺定位應(yīng)用研究[J]. 機(jī)電工程, 2011, 28(8): 934-937.

ZhangJianzhong,HeYongyi,LiJun.ApplicationResearchofVision-locationinRoboticAssemblyEquipment[J].Mechanical&ElectricalEngineer-ing, 2011, 28(8): 934-937.

[2]王東署. 工業(yè)機(jī)器人標(biāo)定技術(shù)研究[D]. 沈陽：東北大學(xué), 2006.

[3]龔星如. 六自由度工業(yè)機(jī)器人運(yùn)動學(xué)標(biāo)定的研究[D]. 南京：南京航空航天大學(xué), 2012.

[4]王琨. 提高串聯(lián)機(jī)械臂運(yùn)動精度的關(guān)鍵技術(shù)研究[D]. 合肥：中國科學(xué)技術(shù)大學(xué), 2013.

[5]OtaH,ShibukawaT,TooyamaT,etal.ForwardKinematicCalibrationMethodforParallelMechani-smUsingPoseDataMeasuredbyaDoubleBallBarSystem[C]//Proc.ParallelKinematicMachines.Paris, 2000: 57-62.

[6]段廣洪，張輝，周潛，等. 剛體空間姿態(tài)測量裝置及其測量方法：中國，200410009083.7[P]. 2004-05-12.

[7]趙偉. 基于激光跟蹤測量的機(jī)器人定位精度提高技術(shù)研究[D].杭州：浙江大學(xué), 2013.

[8]查弘文. 基于立體視覺的測量機(jī)器人的標(biāo)定與測量規(guī)劃[D].南京：南京航空航天大學(xué), 2013.

[9]郭劍鷹,呂恬生.基于主動視覺的機(jī)器人末端姿態(tài)測量[J].上海交通大學(xué)學(xué)報, 2003, 37(5): 715-719.GuoJianying,LüTiansheng.RobotEnd-effectorPoseMeasurementwithActiveVision[J].JournalofShanghaiJiaotongUniversity, 2003, 37(5): 715-719.

[10]LundbergI,Bj?rkmanM, ?grenP.IntrinsicCameraandHand-eyeCalibrationforaRobotVisionSystemUsingaPointMarker[C]//HumanoidRobots(Humanoids), 14thIEEE-RASInternationalConferenceon.Madrid,Spain,IEEE, 2014: 59-66.

[11]秦大輝, 毛婷, 劉建軍. 基于雙目立體視覺的手持式光筆三坐標(biāo)測量系統(tǒng)[J]. 制造技術(shù)與機(jī)床, 2011 (8): 133-136.QinDahui,MaoTing,LiuJianjun.Studyon3D-coordinateMeasuremntTechnologyUsingHandholdLight-penBasedonBinocularStereo-scopicVisionSystem[J].ManufacturingTechnology&Machi-neTool, 2011 (8): 133-136.

[12]張云珠. 工業(yè)機(jī)器人手眼標(biāo)定技術(shù)研究[D]. 哈爾濱: 哈爾濱工程大學(xué), 2009.

[13]TsaiRY.AVersatileCameraCalibrationTechniq-ueforHigh-accuracy3DMachineVisionMetrol-ogyUsingOff-the-shelfTVCamerasandLenses[J].IEEEJournalofRoboticsandAutomation, 1987, 3(4): 323-344.

[14]ZhangZhengyou.AFlexibleNewTechniqueforCameraCalibration[J].PatternAnalysisandMachineIntelligence,IEEETransactionson, 2000, 22(11): 1330-1334.

[15]SongZ,ChungR.UseofLCDPanelforCalibra-tingStructured-light-basedRangeSensingSystem[J].InstrumentationandMeasurement,IEEETransactionson, 2008, 57(11): 2623-2630.

[16]趙亮. 基于旋量的SCARA工業(yè)機(jī)器人精度研究[D].杭州:浙江大學(xué), 2011.

(編輯袁興玲)

Active Light Stereo Target Detection and Its Applications in Industrial Robot’s Pose Measurement

Zhang Xu1,2Zheng Zelong1

1.Shanghai University,Shanghai，200072 2.Shanghai Key Laboratory of Intelligent Manufacturing and Robotic,Shanghai，200072

A visual method with an active light target was proposed to obtain the positions and orientations of robots herein. First, the active light stereo target adopted active infrared light instead of reflective markers and employed shape features instead of brightness features to encode the location informations. Second, the stereo structure was designed to provide the spatial geometric constraint information. The active light target owned five feature planes to expand the visibility no mater what pose. Third, a detection method of feature planes was proposed. The proposed feature detection method was testified under different situations, such as indoor illumination environments, the direct solar radiation at outdoor square and the mixed illumination environments. The experimental results confirmed the feasibility and reliability of the proposed method. Forth, the precision of the proposed visual method was verified in a high precision platform. The experimental results show the average position error is as 0.0857 mm and the average orientation error is as 0.1086° in measuring distance ranging from 0.5～3 m. Finally, the pose measurement of a YASKAWA robot arm, Motoman-MH80, was conducted and the experimental results confirmed the feasibility and efficiency of the proposed method.

full pose measurement of industrial robot; visual measurement; feature detection; active light stereo target

2015-08-31

國家自然科學(xué)基金資助項目(51205244)；機(jī)械系統(tǒng)與振動國家重點實驗室課題資助項目(MSV2015010)；上海市教育委員會科研創(chuàng)新資助項目(2014Z10280034)

TP241.2

10.3969/j.issn.1004-132X.2016.19.007

張旭，男，1982年生。上海大學(xué)機(jī)電工程與自動化學(xué)院副教授、博士。主要研究方向為深度信息獲取和計算機(jī)視覺。鄭澤龍，男，1989年生。上海大學(xué)機(jī)電工程與自動化學(xué)院碩士研究生。