《電子技術(shù)應(yīng)用》
您所在的位置:首頁 > 其他 > 設(shè)計應(yīng)用 > 基于LabVIEW的視覺伺服機械臂控制系統(tǒng)
基于LabVIEW的視覺伺服機械臂控制系統(tǒng)
來源:微型機與應(yīng)用2012年第10期
劉 洋, 方 敏
(合肥工業(yè)大學(xué) 電氣與自動化工程學(xué)院,安徽 合肥 230009)
摘要: 利用PC機、圖像采集卡、攝像頭以及固高公司提供的GT-400-SV-PCI/ISA運動控制卡和GCT-400四自由度直角坐標(biāo)機械臂,在LabVIEW環(huán)境下開發(fā)了視覺伺服機械臂控制系統(tǒng)的實驗平臺,該平臺實現(xiàn)從工件圖像采集到處理以及抓取的功能,操作方便,并具有一定的開放性。
Abstract:
Key words :

摘  要: 利用PC機、圖像采集卡、攝像頭以及固高公司提供的GT-400-SV-PCI/ISA運動控制卡和GCT-400四自由度直角坐標(biāo)機械臂,在LabVIEW環(huán)境下開發(fā)了視覺伺服機械臂控制系統(tǒng)的實驗平臺,該平臺實現(xiàn)從工件圖像采集到處理以及抓取的功能,操作方便,并具有一定的開放性。
關(guān)鍵詞: 機械臂; 圖像處理; 運動控制卡; 人機交互

    LabVIEW是由美國國家儀器公司(NI)開發(fā)的一種圖形化編程語言,廣泛地被工業(yè)界、學(xué)術(shù)界和研究實驗室所接受,視為一個標(biāo)準(zhǔn)的數(shù)據(jù)采集和儀器控制軟件,具有可視化、編程方便等特點[1]。本文利用LabVIEW軟件作為開發(fā)環(huán)境,它的IMAQ Vision Builder模塊是建立在交互式模式和“假設(shè)分析”的環(huán)境基礎(chǔ)上,可快速開發(fā)出圖像處理軟件。將運動控制卡的函數(shù)共享庫導(dǎo)入LabVIEW,通過編程及調(diào)試本文開發(fā)出了視覺伺服控制的實驗平臺。利用LabVIEW圖像化的編程的特點,用戶可以更好地學(xué)習(xí)和二次開發(fā)。
1 系統(tǒng)的硬件結(jié)構(gòu)及原理
    本文采用的機器人是固高公司生產(chǎn)的GRB-400機器人,硬件結(jié)構(gòu)如圖1所示,主要包括以下幾個部分:GRB-400 SCARA型工業(yè)機械臂、GRB四軸驅(qū)動電器箱、GT-400-SG-PCI四軸伺服運動控制卡、CCD攝像頭、計算機和圖像采集卡。機械部分的關(guān)節(jié)1、2、4為旋轉(zhuǎn)關(guān)節(jié)(與圖1中電機1、2、4相對應(yīng)),使用交流伺服電機和諧波減速器驅(qū)動;關(guān)節(jié)3為直線關(guān)節(jié),采用交流伺服電機和滾珠絲杠驅(qū)動。GRB400機器人關(guān)節(jié)1連桿長度200 mm,運動范圍±100°;關(guān)節(jié)2連桿長度200 mm,運動范圍±50°;直線關(guān)節(jié)3行程±48 mm;關(guān)節(jié)4運動范圍±170°。關(guān)節(jié)4安裝了電磁手爪,利用控制器的直接數(shù)字量輸出控制,可以抓取工件。機械臂本體上引出4個關(guān)節(jié)控制軸的電機控制信號、編碼器角度反饋信號和關(guān)節(jié)軸限位信號,通過連接電纜與控制器連接。

    該機器人伺服系統(tǒng)工作過程可概括為:(1)系統(tǒng)利用圖像采集卡對工件的圖像進(jìn)行采集并存入計算機內(nèi)存,通過對圖像進(jìn)行一系列處理,識別出工件并得到工件的位置坐標(biāo);(2)利用基于位置的運動學(xué)反解的方法,計算出1、2軸的運動控制指令,以驅(qū)動1、2軸到達(dá)目標(biāo)位置;(3)通過對手抓的控制實現(xiàn)對目標(biāo)物體的抓取。
2 圖像采集及處理
2.1圖像采集

     圖像采集卡使用的是天敏VC4000圖像采集卡,通過此圖像采集卡和攝像頭采集到工件的圖像,在LabVIEW中進(jìn)行一系列處理,利用圖像采集卡的函數(shù)編寫采集圖像的程序,大致流程為:初始化圖像采集卡、設(shè)置視頻捕獲幀率、打開設(shè)備、開始視頻預(yù)覽、采集圖像并保存(并在此設(shè)置好保存路徑)、釋放資源。
2.2 圖像處理
2.2.1圖像二值化

    圖像的二值化處理就是將256個亮度等級的灰度圖像通過適當(dāng)?shù)拈撝颠x取獲得仍然可以反映圖像整體和局部特征的二值化圖像[2]。要進(jìn)行灰度圖像的處理,首先要進(jìn)行二值化,得到二值化圖像,利于做進(jìn)一步的圖像處理,使處理變得簡單,所有灰度大于或等于閾值的像素判定屬于特定物體(在此屬于工件),其灰度值設(shè)為255,否則這些像素點灰度設(shè)為0,認(rèn)為是背景或者其他物體區(qū)域。閾值的獲取有以下幾種算法:
    圖2為灰度值圖,其中i為灰度值,k為閾值,h(i)為每個灰度值對應(yīng)的像素點個數(shù),N為灰色圖像中像素總數(shù),n為圖像像素總數(shù)。

     

3 機械臂控制系統(tǒng)的設(shè)計
    首先在開始工件抓取之前要對機械臂進(jìn)行回零,其次利用上面圖像處理得到的工件位置坐標(biāo)進(jìn)行關(guān)節(jié)角度反解,進(jìn)而轉(zhuǎn)化脈沖輸入到每軸對應(yīng)的電機的控制器中,驅(qū)動機械臂運動到工件實際位置進(jìn)行抓取。
3.1機械臂的回零
     在機械臂工作之前,首先要進(jìn)行機械臂的回零,在機械臂的工作臺上原點對應(yīng)的位置坐標(biāo)(x,y)已經(jīng)確定,將其通過角度反解轉(zhuǎn)化為關(guān)節(jié)角度對應(yīng)的脈沖輸入到回零函數(shù)中,實現(xiàn)機械臂的回零,下面對每個軸的回零進(jìn)行闡述。
    (1)軸1軸2:首先通過機械臂運動時捕獲限位開關(guān)(利用控制函數(shù)獲取軸的狀態(tài)值,其14 bit是設(shè)定Home開關(guān)信號捕獲標(biāo)志),再利用限位開關(guān)捕獲原點。具體實現(xiàn)是利用獲得當(dāng)前軸的實際位置值,再用(其中offset是原點位置坐標(biāo)角度反解得到的脈沖)使其回到零點。
    (2)軸3:利用原點開關(guān)捕獲原點,通過GT_SetPos(pos+maxPositiveOffset)、GT_SetPos(pos-maxPositiveOffset)結(jié)合GT_GetSts(&str)捕獲到原點。

    根據(jù)幾何關(guān)系得出軸1軸2的關(guān)節(jié)角度,再轉(zhuǎn)化為關(guān)節(jié)1、2對應(yīng)電機需要的脈沖數(shù),然后輸入到運動控制函數(shù)GT_SetPos( )設(shè)置當(dāng)前軸的目標(biāo)位置。
3.3 視覺抓取的程序設(shè)計
    在機械臂的視覺抓取程序中,為了使用戶可以了解機器人采集圖像及處理圖像的過程,編寫了視覺處理及抓取工件的程序,圖4是程序的前面板。

 

 

    首先在圖像采集及處理區(qū)進(jìn)行圖像的采集,此時可在圖像顯示區(qū)看到工件的原始圖像;再進(jìn)行二值化處理,可在下拉菜單中嘗試圖像熵法、Intervariance法和Metric法;然后再對圖像進(jìn)行邊緣提取,可在下拉菜單中嘗試上面提到的3種算子;最后提取工件的中心坐標(biāo),在機器人運動控制區(qū)打開運動控制卡、上電、抓取工件(此時機械臂會自動先進(jìn)行回零)。
    該系統(tǒng)將LabVIEW與固高運動控制卡相結(jié)合,實現(xiàn)了視覺抓取的功能,利用LabVIEW開發(fā)的視覺抓取的界面,功能和用法一目了然,使用戶的操作簡單、易懂,并具有一定的開放性。
參考文獻(xiàn)
[1] 楊忠仁. 基于LabVIEW數(shù)據(jù)采集系統(tǒng)[J]. 重慶大學(xué)學(xué)報(自然科學(xué)版), 2007,24(2):32-35.
[2] 王剛.圖像二值化方法研究及其在監(jiān)控識別系統(tǒng)中的應(yīng)用[D].長沙:湖南大學(xué),2010.
[3] 美國國家儀器(NI)有限公司.Labview Vision conceps help.(2011-06)[2012-03-18]http://www.ni.com/vision/zhs/vdm.htm.
[4] 朱柱.邊緣檢測技術(shù)研究[D].蘇州:蘇州大學(xué),2010.
[5] 劉微.基于邊緣檢測的移動機器人視覺導(dǎo)航方法研究[D].沈陽:沈陽理工大學(xué),2010.
[6] 李宏慶.基于視覺的六自由度機械臂控制技術(shù)研究[D].南京:南京理工大學(xué),2010.

此內(nèi)容為AET網(wǎng)站原創(chuàng),未經(jīng)授權(quán)禁止轉(zhuǎn)載。