郁正綱 YU Zheng-gang；丁偉 DING Wei；李瑋 LI Wei

（①江蘇安方電力科技有限公司，泰州 225300；②國網(wǎng)江蘇省電力有限公司雙創(chuàng)中心，南京 210000）

0 引言

在生產(chǎn)流水線中，工業(yè)機器人主要依靠示教或離線編程的形式來引導(dǎo)機械手抓取和放置工件，這種方式存在較大局限性，主要體現(xiàn)在兩個方面[1]：一是工作環(huán)境發(fā)生變化后，由于缺乏應(yīng)變能力，機器人的操作范圍嚴(yán)重受限，導(dǎo)致任務(wù)中斷或失?。蝗绻ぜ趥魉瓦^程中發(fā)生位置偏移，機器人依舊執(zhí)行既定操作，則會降低工件放置的精確度。二是自動化水平偏低的工廠應(yīng)用工業(yè)機器人參與生產(chǎn)流程，必須搭建配套的生產(chǎn)線，導(dǎo)致前期投資增加。隨著工業(yè)生產(chǎn)需求的多樣化，如何使工業(yè)機器人準(zhǔn)確識別工件并引導(dǎo)機械手抓取工件已成為自動化生產(chǎn)領(lǐng)域面臨的挑戰(zhàn)之一。機器視覺技術(shù)具有精度高、信息量大、檢測范圍廣、開發(fā)潛能大等特點，將其應(yīng)用于工業(yè)自動化中能夠快速精確識別工件、測量目標(biāo)尺寸和位姿[2]。本研究針對工業(yè)機器人機械臂抓取過程中的工件識別與定位問題進行探究。

1 單目視覺定位模型構(gòu)建

本研究選取M2S036 工業(yè)相機采集工件圖像，為滿足機器人抓取所需要的三維空間信息，必須構(gòu)建小孔成像模型，將圖像投影至二維平面中，確定相機成像內(nèi)外部參數(shù)，并運用算法計算目標(biāo)姿態(tài)與空間位置。如圖1 所示。

圖1 小孔成像模型

1.1 圖像坐標(biāo)系與像素坐標(biāo)系的轉(zhuǎn)化

假設(shè)重心坐標(biāo)（u0，v0）和像素點的物理尺寸dx、dy，可以得到如下轉(zhuǎn)換關(guān)系式：

1.2 三維空間坐標(biāo)的計算

基于相同發(fā)射光心點O，將OOc作為攝像機的焦距f，通過矩陣轉(zhuǎn)換得到圖像坐標(biāo)系oxy 與相機坐標(biāo)系OcXcYcZc轉(zhuǎn)換關(guān)系式：

世界參考坐標(biāo)系OwXwYwZw與相機坐標(biāo)系構(gòu)成OcXcYcZc存在剛體變換關(guān)系，可通過矩陣的齊次轉(zhuǎn)化得到兩者轉(zhuǎn)換關(guān)系式：

其中，R、T 分別表示旋轉(zhuǎn)矩陣、平移矢量，均屬于相機外參矩陣。

聯(lián)立上述公式可得到世界參考坐標(biāo)系OwXwYwZw矩陣函數(shù)：

圖像傳感器的像素陣列為m×n，目標(biāo)的長度Lx、寬度Ly，目標(biāo)長邊像素點個數(shù)lx、寬邊像素點個數(shù)ly，得到公式[3]：

計算均值并將其帶入世界坐標(biāo)矩陣函數(shù)中，即可得到目標(biāo)三維空間坐標(biāo)數(shù)據(jù)。

2 基于單目視覺的目標(biāo)識別與定位算法

2.1 工件圖像預(yù)處理

本文使用局部直方圖均衡化進行處理，具體流程為：首先，輸入原始圖像及其圖像灰度fj（j=0，1，…，L-1），計算灰度像素數(shù)量nj（j=0，1，…，L-1）；其次，根據(jù)圖像灰度及灰度像素數(shù)量計算得到圖像直方圖Pf（fj）=nj/n，其中n 表示圖像總像素數(shù)量；再次，得到累積分布函數(shù)c（f），計算映射后的圖像灰度gj=INT[（gmax-gmin）c（f）+gmin+0.5]；最后，統(tǒng)計像素灰度數(shù)量ni（i=0，1，…，p-1），得到直方圖Pg（gi）=ni/n，i=0，1，…，p-1。結(jié)合fj與gj的映射關(guān)系，得到的圖像直方圖呈均勻分布。

2.2 工件圖像特征提取

因此，本文采用隨機樹算法進行圖像特征點匹配，具體流程如圖2 所示。基于隨機樹的特征匹配算法原理為：建立隨機樹分類器Y，將圖像特征點匹配問題轉(zhuǎn)換為待匹配特征點與模板特征點集合C 中的哪個特征點相符Y（k）∈C={-1，1，2，…，N}，如果Y（k）=-1 則表示匹配失敗。隨機樹為一顆二叉樹，從根節(jié)點開始，每個節(jié)點劃分兩個子節(jié)點，依據(jù)分類準(zhǔn)則判斷輸入對象進入哪個子節(jié)點，從而完成特征點分類。

圖2 隨機樹算法流程圖

Harris 角點檢測法對于圖像變化具有較強的適應(yīng)性和旋轉(zhuǎn)不變性，本文首先運用該方法對模板圖像特征點進行檢測，計算圖像窗口移動所產(chǎn)生的灰度變化，尋找角點并將其作為圖像特征點；然后以特征點為中心建立圖塊p（n×n），將所有圖塊輸入隨機樹，計算不同類型圖塊的統(tǒng)計概率；最后判斷圖塊走向，除特征點外，隨機選擇圖塊中的兩個像素點，對其灰度值進行比較，若m1＞m2，則圖塊走向右節(jié)點，反之則走向左節(jié)點。選定比較像素點后，下一個圖塊進入該節(jié)點時，仍以之前選取的兩個像素點的比較為判斷準(zhǔn)則。節(jié)點比較公式為：

式中，I（p，m2）為圖塊p 中像素點m 的灰度值。將所有圖塊輸入隨機樹后，在葉節(jié)點處得到相應(yīng)的概率分布情況，即待檢測特征點的分類準(zhǔn)則。

本文使用多棵隨機樹對不同區(qū)域的特征點進行分類，同時圖塊多大會降低分類準(zhǔn)確性和計算效率，綜合考慮上述因素最終經(jīng)過多次參數(shù)調(diào)整驗證，確定了隨機樹的棵數(shù)為30，層數(shù)為11，圖塊尺寸為17，建立隨機樹分類器，得到圖塊p 的概率分布：

其中，Y（p）為圖塊分類結(jié)果，c 為特征點類別，η（l，p）為圖塊到達第l 棵樹的葉節(jié)點，為到達葉節(jié)點中圖塊p 的數(shù)量和所有圖塊數(shù)比值。

最后，根據(jù)所有特征點圖塊的概率分布情況對待檢測點進行類別匹配，建立圖塊與模板圖像中某圖塊的匹配關(guān)系：

2.3 工件位姿估計

計算目標(biāo)工件的圖像姿態(tài)，即求取目標(biāo)工件主軸與圖像坐標(biāo)系Xw軸的夾角θ，若夾角θ 位于Y 正方向則θ＞0，若夾角θ 位于Y 負(fù)方向則θ＜0。假設(shè)目標(biāo)兩條平行邊上像素點坐標(biāo)，計算該點斜率來確定其與主軸的夾角[4]：

本文采用張正友標(biāo)定法獲得圖像坐標(biāo)系與相機坐標(biāo)系的轉(zhuǎn)換關(guān)系，使用Tsai-Lenz 標(biāo)定法確定相機坐標(biāo)系與機器人坐標(biāo)系的轉(zhuǎn)換關(guān)系，然后基于隨機樹算法通過特征點的像素坐標(biāo)、世界坐標(biāo)求得目標(biāo)工件的實際位姿，從而引導(dǎo)機械臂抓取工件。

3 試驗結(jié)果與分析

3.1 設(shè)定實驗條件

本研究根據(jù)實驗需要搭建了單目視覺定位系統(tǒng)，該系統(tǒng)由ABB-IRB120 型工業(yè)機器人、Mecanum 輪移動平臺、Artcam-130mi-nir 工業(yè)相機、氣動手爪、控制器組成。實驗控制系統(tǒng)中，由上位機進行圖像處理和總體控制，工業(yè)相機接口為GigE，通過千兆以太網(wǎng)實現(xiàn)與上位機之間的通訊。

3.2 特征匹配算法性能驗證

本研究將該算法與基于RANSAC 方法改進的SIFT算法性能進行對比。雜亂、傾斜、遮擋、陰暗四種情況下，兩種算法的特征匹配效果如圖3、圖4 所示。兩種算法的特征點匹配率以及匹配時間如表1 所示。

表1 隨機樹算法與改進SIFT 算法的特征點匹配結(jié)果

圖3 基于隨機樹的特征匹配效果圖

圖4 基于改進SIFT 算法的特征匹配效果圖

從表1 可以看出，在遮擋、陰暗環(huán)境下，隨機樹算法和改進SIFT 算法檢測到的特征點偏少，匹配率較低；在雜亂、傾斜環(huán)境下，兩種算法檢測到的特征點較多，運算時間較長。可以發(fā)現(xiàn)，隨機樹算法的匹配率更高、運算時間更短，原因在于該算法在目標(biāo)識別之前就通過離線訓(xùn)練對穩(wěn)定特征點進行了篩選，剔除了不穩(wěn)定的特征點；改進SIFT算法在線檢測特征點過多，并且直接進行在線匹配，經(jīng)過RANSAC 算法剔除錯誤的匹配點后，導(dǎo)致匹配率較低。

3.3 工件定位實驗

使用ABB-IRB120 型工業(yè)機器人進行工件定位實驗。本研究共進行6 組抓取實驗，每次實驗中抓取不同位姿的工件，并記錄平均抓取位置誤差，實驗結(jié)果如表2 所示。同時，機械臂完成抓取作業(yè)后，需將工件放置在特定工位，共進行6 組放置實驗，記錄每次實驗的平均放置誤差，實驗結(jié)果如表3 所示。

表2 單目視覺系統(tǒng)抓取作業(yè)最大誤差

表3 單目視覺系統(tǒng)放置作業(yè)最大誤差

可以看出，單目視覺定位系統(tǒng)放置作業(yè)X、Y、Z 方向的最大誤差范圍為1.1～6.3mm，比抓取作業(yè)的精度稍高，這是因為進行放置作業(yè)時，指定工位點的標(biāo)志圖案擺放整齊，相機采集到的正俯視圖與圖像模板的姿態(tài)相近，因此計算得到的工件位姿誤差較小。

4 結(jié)論

本研究提出了一種基于隨機樹的特征匹配算法，實現(xiàn)對目標(biāo)工件特征點的識別與定位，該算法較基于RANSAC改進的SIFT 算法相比具有更高的性能，匹配率更高、匹配速度更快。工件定位實驗結(jié)果表明單目視覺定位系統(tǒng)能夠精確識別與定位工件，較好地引導(dǎo)移動機械臂完成工件抓取與放置作業(yè)，對于提升工業(yè)生產(chǎn)效率具有重要意義。