摘 要: 利用PC機、圖像采集卡、攝像頭以及固高公司提供的GT-400-SV-PCI/ISA運動控制卡和GCT-400四自由度直角坐標機械臂,在LabVIEW環(huán)境下開發(fā)了視覺伺服機械臂控制系統(tǒng)的實驗平臺,該平臺實現(xiàn)從工件圖像采集到處理以及抓取的功能,操作方便,并具有一定的開放性。
關(guān)鍵詞: 機械臂; 圖像處理; 運動控制卡; 人機交互
LabVIEW是由美國國家儀器公司(NI)開發(fā)的一種圖形化編程語言,廣泛地被工業(yè)界、學(xué)術(shù)界和研究實驗室所接受,視為一個標準的數(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)利用圖像采集卡對工件的圖像進行采集并存入計算機內(nèi)存,通過對圖像進行一系列處理,識別出工件并得到工件的位置坐標;(2)利用基于位置的運動學(xué)反解的方法,計算出1、2軸的運動控制指令,以驅(qū)動1、2軸到達目標位置;(3)通過對手抓的控制實現(xiàn)對目標物體的抓取。
2 圖像采集及處理
2.1圖像采集
圖像采集卡使用的是天敏VC4000圖像采集卡,通過此圖像采集卡和攝像頭采集到工件的圖像,在LabVIEW中進行一系列處理,利用圖像采集卡的函數(shù)編寫采集圖像的程序,大致流程為:初始化圖像采集卡、設(shè)置視頻捕獲幀率、打開設(shè)備、開始視頻預(yù)覽、采集圖像并保存(并在此設(shè)置好保存路徑)、釋放資源。
2.2 圖像處理
2.2.1圖像二值化
圖像的二值化處理就是將256個亮度等級的灰度圖像通過適當?shù)拈撝颠x取獲得仍然可以反映圖像整體和局部特征的二值化圖像[2]。要進行灰度圖像的處理,首先要進行二值化,得到二值化圖像,利于做進一步的圖像處理,使處理變得簡單,所有灰度大于或等于閾值的像素判定屬于特定物體(在此屬于工件),其灰度值設(shè)為255,否則這些像素點灰度設(shè)為0,認為是背景或者其他物體區(qū)域。閾值的獲取有以下幾種算法:
圖2為灰度值圖,其中i為灰度值,k為閾值,h(i)為每個灰度值對應(yīng)的像素點個數(shù),N為灰色圖像中像素總數(shù),n為圖像像素總數(shù)。
3 機械臂控制系統(tǒng)的設(shè)計
首先在開始工件抓取之前要對機械臂進行回零,其次利用上面圖像處理得到的工件位置坐標進行關(guān)節(jié)角度反解,進而轉(zhuǎn)化脈沖輸入到每軸對應(yīng)的電機的控制器中,驅(qū)動機械臂運動到工件實際位置進行抓取。
3.1機械臂的回零
在機械臂工作之前,首先要進行機械臂的回零,在機械臂的工作臺上原點對應(yīng)的位置坐標(x,y)已經(jīng)確定,將其通過角度反解轉(zhuǎn)化為關(guān)節(jié)角度對應(yīng)的脈沖輸入到回零函數(shù)中,實現(xiàn)機械臂的回零,下面對每個軸的回零進行闡述。
(1)軸1軸2:首先通過機械臂運動時捕獲限位開關(guān)(利用控制函數(shù)獲取軸的狀態(tài)值,其14 bit是設(shè)定Home開關(guān)信號捕獲標志),再利用限位開關(guān)捕獲原點。具體實現(xiàn)是利用獲得當前軸的實際位置值,再用(其中offset是原點位置坐標角度反解得到的脈沖)使其回到零點。 大功率電感廠家 |大電流電感工廠