視覺工業(yè)點鹵機器人控制系統(tǒng)研究

黃良沛 劉 洋 舒 勇

(湖南科技大學機電工程學院，湖南 湘潭 411100)

隨著市場規(guī)模的不斷擴大、人力成本的不斷增加，傳統(tǒng)的手工點鹵已不能適應檳榔加工產(chǎn)業(yè)的發(fā)展需求。為實現(xiàn)點鹵作業(yè)的機械化和自動化，提高企業(yè)效率與產(chǎn)品質(zhì)量，急需研發(fā)出一款基于視覺的自動點鹵伺服系統(tǒng)。方新國[1]設計了檳榔全自動點鹵機，通過振動送料器完成檳榔單顆粒送料，當檳榔到達指定位置時，通過定位鎖死裝置將檳榔固定并完成點鹵，再通過卸料皮帶將檳榔輸送至出料框中，完成檳榔出料。李海生[2]設計了一種檳榔智能化點鹵系統(tǒng)，通過在系統(tǒng)中增添視覺識別系統(tǒng)和點鹵機械手實現(xiàn)對檳榔的位置識別、朝向識別和正反面識別以及檳榔的抓取定位、傳輸移動和點鹵下料等。裴樂[3]設計了一種自動點鹵機，通過人工擺料和皮帶輸送，再通過限位檢測、激光檢測以及微電腦控制實現(xiàn)檳榔的精確點鹵，并通過去廢機械手對多余檳榔進行剔除。陳玉林等[4]根據(jù)多軸運動控制的需要，設計了一套基于觸摸屏和運動控制卡的控制系統(tǒng)。王振成等[5]建立全自動果凍食品高速雙面貼標機伺服系統(tǒng)的動力學模型，得出伺服系統(tǒng)的等效轉(zhuǎn)動慣量和等效綜合剛度。郭茂森等[6]采用可靠穩(wěn)定的硬件系統(tǒng)和軟件系統(tǒng)，借助Visual Studio集成開發(fā)環(huán)境，搭建人機交互界面，并以運動控制卡為核心控制驅(qū)動器和步進電機，最終實現(xiàn)了多軸的聯(lián)動控制。杜建等[7]采用Delta2機器人結(jié)構，開發(fā)了一款性能穩(wěn)定的全自動立式袋裝箱機。為實現(xiàn)開放式工作臺的直線進給運動，采用運動控制卡和伺服電機相結(jié)合的技術，通過Visual Studio C#編程實現(xiàn)了絲杠螺母副直線運動平臺的運動控制，利用光柵測量平臺位移反饋給運動控制系統(tǒng)，實現(xiàn)了直線運動平臺的閉環(huán)控制，提高了平臺運動的控制精度[8]。研究擬采用運動控制卡+工控機+工業(yè)相機的架構，并基于Opencv視覺庫進行自動定位，在此基礎上完成基于機器視覺的高速、高精度的點鹵控制系統(tǒng)的研發(fā)，完成檳榔的自動點鹵，旨在為全自動檳榔點鹵控制方案的設計提供依據(jù)。

1 工作原理

1.1 點鹵機組成

該系統(tǒng)主要由視覺檢測定位系統(tǒng)、控制系統(tǒng)、伺服系統(tǒng)組成(見圖1)。其中，視覺系統(tǒng)由PC機、相機和光源控制器組成。相機對檳榔進行圖像采集，由PC機上的視覺軟件進行圖像處理獲取中心點及點鹵坐標；光源控制器是照明系統(tǒng)的核心部件，調(diào)節(jié)光照亮度，提高圖像采集的精度。控制系統(tǒng)包括運動控制器和外圍電路，運動控制器負責坐標轉(zhuǎn)換，進而控制伺服系統(tǒng)。伺服系統(tǒng)采用雙軸機械系統(tǒng)，故X軸、Y軸均配有伺服電機與伺服驅(qū)動器。

圖1 系統(tǒng)結(jié)構圖Figure 1 System structure diagram

1.2 點鹵機工作流程

點鹵機的工作流程如圖2所示。采集到的檳榔圖像通過一系列圖像處理過程得到每個檳榔的點鹵點位，通過相機標定確定像素點坐標和實際點鹵的坐標重合，根據(jù)得到的檳榔點鹵點位進行點鹵軌跡規(guī)劃，再通過運動控制卡驅(qū)動點鹵軸對檳榔進行點鹵，同時對坐標進行修正。

1.3 圖像處理

圖像采集來源于檳榔自動點鹵機的圖像采集系統(tǒng)，先將采集到的圖像進行圖像增強，提高圖像的對比度和亮度；將圖像增強后的RGB圖像轉(zhuǎn)換至HSV空間，從HSV顏色空間中分離出H通道圖像；對H通道圖像進行Otsu圖像分割，得到只有前景和背景的二值圖像；由于分割出來的圖像存在孔洞和小連通域噪點，結(jié)合區(qū)域生長法和圖像形態(tài)學去除其中的孔洞和小連通域，得到不帶噪點的完整的二值圖像；通過繪制連通域的最小外接矩形對識別出的檳榔圖像進行標注。

采集系統(tǒng)采用Opencv視覺庫進行圖像處理，其具體工作原理見圖3。圖像經(jīng)伽馬變換[9]、提取H通道、Otsu圖像分割[10]、去除孔洞和小連通域、圖像位運算、Retinex圖像增強算法[11]、邊緣檢測、橢圓擬合法等一系列圖像運算，得到每個檳榔的點鹵點位，再根據(jù)點鹵點位進行點鹵軌跡規(guī)劃。該方法能準確地識別出檳榔，能有效避免錯誤和錯點。

2 硬件設計

2.1 點鹵工作臺進給系統(tǒng)建模

點鹵工作臺進給原理如圖4所示，控制系統(tǒng)的進給傳動部分由電機提供扭矩，聯(lián)軸器將電機主軸與絲杠相連，滾珠絲桿將轉(zhuǎn)動轉(zhuǎn)變?yōu)楣ぷ髋_X軸的直線運動，Y軸方向進給原理與X軸相同。

圖2 點鹵機的工作原理圖Figure 2 Working principle of the dispenser

圖3 圖像處理流程圖Figure 3 Image processing flowchart

基于X-Y工作臺進給系統(tǒng)，考慮傳動機構之間的摩擦，建立單軸工作臺動力學模型。轉(zhuǎn)矩平衡方程表示為：

(1)

絲杠進給轉(zhuǎn)矩平衡方程表示為：

MS=K[θM-θL]。

(2)

圖4 單軸工作臺進給原理Figure 4 Single axis table feed principle

圖5 單軸工作臺進給系統(tǒng)動力學模型Figure 5 Dynamic model of single-axis table feed system

由式(1)、(2)可得傳遞函數(shù)為：

(3)

式中：

JL——合成的總轉(zhuǎn)動慣量，kg·m2；

fL——等效阻尼系數(shù)；

K——等效剛度，N/m；

MS——絲杠的力矩，N·m；

fL——等效阻尼系數(shù)；

KL——傳動總扭轉(zhuǎn)剛度，N/m；

Mgr——等效負載轉(zhuǎn)矩，N·m；

JL——工作臺與傳動之間的總轉(zhuǎn)動慣量，kg·m2；

θM——輸入角位移，rad；

θL——輸出角位移，rad。

2.2 點鹵工作臺摩擦建模

點鹵X-Y平臺摩擦建模系統(tǒng)采用Stribeck摩擦模型(見圖6)。摩擦力由最大靜摩擦變?yōu)閹靵瞿Σ粒且粋€連續(xù)的過程，如式(4)和式(5)所示。

(4)

F(v)=[Fc+(Fs-Fc)e-|v/vs|δs]sgn(v)+Bv，

(5)

式中：

F——摩擦力，N；

v——接觸面間相對速度，m/s；

Fe——外界作用力，N；

Fs——最大靜摩擦力，N；

FC——庫侖摩擦力，N；

vs——Stribeck速度，m/s；

δs——常數(shù)(其大小決定Stribeck曲線的形狀)；

B——黏滯摩擦系數(shù)。

根據(jù)點鹵X-Y平臺Stribeck摩擦模型采用Simulink進行仿真(見圖7)。仿真參數(shù)設置：最大靜摩擦力26.978 4 N，庫侖摩擦力18.927 2 N，黏滯摩擦系數(shù)56.622 3，Stribeck臨界速度0.017 2 m/s。

圖6 摩擦模型Figure 6 Friction model

圖7 仿真摩擦模型Figure 7 Simulation friction model

2.3 結(jié)構組成

根據(jù)系統(tǒng)方案設計要求，機械架構由機體框架、運動控制平臺、擺盤定位機構、控制面板、相機安裝支架組成。機體框架采用304不銹鋼材，保證食品衛(wèi)生和安全；運動控制平臺由兩個高精度的十字滑臺組成，分別采用4個伺服電機進行驅(qū)動，保證精度要求；擺盤定位機構由4個安裝塊組成，由螺釘進行夾緊。機器視覺伺服點鹵系統(tǒng)具體結(jié)構如圖8所示。

根據(jù)系統(tǒng)需求進行硬件選型，系統(tǒng)設備配置見表1。

1. 點鹵平臺 2. 機械按鈕 3. PC機 4. 進電總開關 5. 電磁閥 6. 擺盤底座 7. 檳榔擺盤 8. CCD相機 9. 激光 10. 點鹵軸 11. LED照明燈圖8 機器視覺伺服點鹵系統(tǒng)具體結(jié)構Figure 8 The specific structure of the machine vision servo point halogen system

表1 系統(tǒng)設備配置表

3 軟件設計

搭建好硬件平臺，確定相機、運動控制器和伺服控制器的相互通信正常，在VS2015軟件編程環(huán)境下編寫程序，實現(xiàn)對機器人平臺的控制。① 伺服系統(tǒng)使能，然后再對X軸、Y軸分別設定原點；② 機械臂使能，控制機械臂動作，獲取檳榔圖像，提取目標中心點邊緣坐標，選取具有代表性的像素點，配置坐標輸出，使用函數(shù)讀取坐標并轉(zhuǎn)換；③ 整個機器人使能，先設置一個延時，再使用指令實現(xiàn)運動平臺按采集的坐標路徑運動，并將點鹵效果顯示至觸摸屏上。

3.1 圖像處理

由檳榔自動點鹵機的圖像采集系統(tǒng)采集的圖像如圖9(a) 所示。經(jīng)伽馬變換后，圖像亮度得到明顯增強，對比度也增強。變換后的圖像如圖9(b)所示。

以RGB圖像為基礎，將圖像轉(zhuǎn)換到HSV顏色空間進行分析。HSV顏色空間通過色相(H)、飽和度(S)和明度(V)3個分量對色彩進行描述。HSV顏色空間各分量圖如圖10所示。

圖像采用Otsu圖像分割算法對H分量圖像進行分割，結(jié)果如圖11所示。文中結(jié)合了區(qū)域生長法和膨脹操作有效地去除小連通域和孔洞，得到完整去除孔洞、小連通域和內(nèi)部完整的圖像。處理后的圖像如圖12所示。

圖9 原始圖像及伽馬增強圖像Figure 9 Original image and gamma enhanced image

圖10 HSV顏色空間分量圖Figure 10 HSV color space component map

圖11 Otsu分割圖像Figure 11 Otsu split image

源圖像經(jīng)伽馬變換、提取H分量圖像、Otsu圖像分割、去除孔洞和連通域，再使用繪制出連通域的最小外接矩形框?qū)⒆R別出的檳榔框選，實現(xiàn)檳榔的識別與定位，結(jié)果如圖13所示。

采用最小二乘法擬合橢圓，先假設橢圓參數(shù)，得到每個待擬合點到該橢圓誤差距離的平方和，再求出使這個和最小的橢圓參數(shù)。在橢圓中心線上取7個點，去掉首末兩點，最終每顆檳榔保留5個點，結(jié)果如圖14所示。根據(jù)生產(chǎn)的需求，設置的最佳路徑如圖15所示。

圖12 去除孔洞和小連通域圖像Figure 12 Remove holes and small connecteddomain images

圖13 檳榔識別圖像Figure 13 Betel nut recognition image

圖14 點鹵坐標圖像Figure 14 Point halogen coordinate image

圖15 點鹵軌跡規(guī)劃圖像Figure 15 Point halogen trajectory planning image

3.2 運動控制軟件設計及人機交互界面

運動控制系統(tǒng)主要由初始化模塊、單軸運動模塊、插補模塊、狀態(tài)間監(jiān)測模塊、緊急停止模塊5部分組成。為了用戶開機后可以進行多軸補間運動，系統(tǒng)中增加了一鍵回零功能。人機交互界面的整體設計采用VS2015中的MFC控件，大大增加了系統(tǒng)的可拓展性，同時也節(jié)省了界面空間。控制系統(tǒng)的人機交互界面整體設計如圖16所示，插補運動、點到點運動、勻速運動和搜索零點運動如圖17所示。

4 點鹵測試

主要驗證絲杠機械誤差、絲杠行程測試和整機測試。采用量程為80 mm的激光位移傳感器和采樣通道數(shù)為1，采樣速率為1 000 s-1，數(shù)據(jù)采集卡進行測試，控制誤差為0.5 mm以內(nèi)，檳榔識別點位如圖18所示。

5 試驗分析

5.1 絲杠機械誤差測試

驅(qū)動器給定輸入1 200脈沖為電機軸轉(zhuǎn)一圈，進行20次5 mm的運動測試和數(shù)據(jù)采集，取其中一次測試可得誤差位移—時間圖及誤差圖(見圖19)，進行1 000次數(shù)據(jù)采樣可得絲杠機械誤差圖(見圖20)。由圖20可知，絲杠機械誤差≤0.4 mm，符合設計要求。

5.2 絲杠行程測試

在負極限位置至正極限位置進行相對位置運動，進行20次150 mm的運動測試和數(shù)據(jù)采集，取其中一次測試獲取絲杠行程測試位移時間圖(見圖21)，進行1 000次數(shù)據(jù)采樣可得絲杠機械誤差圖(見圖22)。由圖22可知，絲杠機械誤差≤0.4 mm，符合設計要求。

5.3 系統(tǒng)精度

取4枚一元硬幣，每枚硬幣直徑為25 mm。用一枚硬幣直徑測系統(tǒng)的精度，由視覺軟件測得圖像坐標系下長度454 Pixel，距離倍率454/25。

控制點鹵頭運行25 mm硬幣直徑距離，并用視覺相機采集起點和終點的圖像坐標，重復進行此記錄數(shù)據(jù)，結(jié)果如表2所示。

圖16 點鹵系統(tǒng)人機交互界面Figure 16 Human-computer interaction interface of point halogen system

圖17 點鹵系統(tǒng)控制功能Figure 17 Adding bittern system control function

按式(6)和式(7)計算距離重復性誤差。

(6)

圖18 檳榔識別點位圖Figure 18 Recognition point map of betel nut

圖19 絲杠機械誤差位移—時間圖Figure 19 Lead screw mechanical error displacement-time chart

圖20 絲杠機械誤差圖Figure 20 Mechanical error diagram of screw

圖21 絲杠行程測試位移時間圖Figure 21 Lead screw stroke test displacement time chart

圖22 絲杠行程測試位移誤差圖Figure 22 Displacement error diagram of screw stroke test

表2 距離重復性試驗

(7)

式中：

RD——距離重復性誤差；

D——距離平均值。

由表2可知，RD=0.57 Pixel=0.03 mm，故系統(tǒng)誤差精度達到0.03 mm。

6 結(jié)論

研究了視覺檢測的智能點鹵系統(tǒng)，并對其運動控制系統(tǒng)軟件功能進行了測試，主要包括絲杠機械誤差測試和行程測試。結(jié)果表明，系統(tǒng)誤差控制在0.4 mm以內(nèi)，滿足設計要求。對試驗平臺進行搭建和點鹵測試，其結(jié)果滿足工業(yè)要求且時間控制在21 s內(nèi)，提高了系統(tǒng)的快速性和可靠性。試驗控制系統(tǒng)硬件結(jié)構為開環(huán)控制，后續(xù)可加入反饋環(huán)節(jié)，如位移、速度等，進一步提升其定位精度；各模塊中可加入智能算法(模糊PID等)，實現(xiàn)誤差的自動補償；可將控制系統(tǒng)與工業(yè)互聯(lián)網(wǎng)進行結(jié)合，開發(fā)遠程數(shù)據(jù)存儲和報表生成等模塊，使系統(tǒng)更智能化。