基于DSP和μC/OS-II 的采摘機器人視覺系統設計

申一歌，靳 果

(河南工業職業技術學院，河南 南陽 473000)

?

基于DSP和μC/OS-II 的采摘機器人視覺系統設計

申一歌，靳 果

(河南工業職業技術學院，河南 南陽 473000)

近年來，國內機器視覺發展速度較快，應用廣泛。由于視覺系統需要處理視頻圖像信息，計算量較大，因此當前該系統多采用計算機系統進行搭建。為此，提出將嵌入式與視覺系統結合應用的思想，并利用視覺系統和嵌入式智能系統易于信息集成的特點，設計了一種基于DSP和uC/OS-II的視覺系統。該方案主要包括硬件軟件及操作系統的設計，大大提高了生產的效率和自動化程度，對實現視覺系統在采摘機器人中的應用具有重要意義。

采摘機器人；機器視覺系統；DSP；uC/OS-II

0 引言

隨著新興電子集成技術和自動化技術的發展，控制系統已逐漸向數字化轉變，高集成芯片廣泛應用于自動化控制領域，體積小、運算能力強的嵌入式系統慢慢開始取代計算機。當前，嵌入式系統已成功應用到工業智能控制、光機電設備、自動檢測、通信設備、儀器儀表及機器人控制等領域。制造研究出替代人類勞動的機器人是人類長期以來的夢想，對于一些高危險工作或人工視覺難以判斷的情況，常常需要利用機器視覺系統來完成。同時，在簡單重復作業中，利用人工操作不僅費時費力、效率低而且誤差大，機器視覺技術能夠大大提高生產的效率和作業精度，容易集成信息，從而實現自動化。

1 嵌入式機器視覺系統總體設計

嵌入式系統(Embedded System)是一種“完全嵌入受控器件內部、為特定應用而設計的專用計算機系統”,其本身是一個相對模糊的定義，通常一個MP3或者一個微型工業機也可以被認定為一個嵌入式系統。

機器視覺系統的目的是給機器或者自動化生產線增加一套視覺系統，利用計算機或者圖像處理系統及相關設備來模擬人的視覺行為，獲取人的視覺系統所能獲得的信息。該系統是采摘機器人對成熟果實的判別和定位的重要技術手段，視覺傳感器根據圖像處理系統和雙目視覺技術可以獲取果園中復雜環境和作業對象的信息。其主要功能是：①判斷目標果實是否成熟；②對目標果實進行三維定位；③對機器運動軌跡進行優化。典型的機器視覺系統構架如圖1所示。

圖1 典型的機器視覺系統構架Fig.1 Typical machine vision system architecture

機器視覺系統由光源、鏡頭、CCD攝像機及圖像采集系統構成，主要是利用智能化設備模擬人和生物的視覺系統功能，使機器人具有對空間物體進行傳感和判斷的能力，從而完成識別和理解的目的。

2 采摘機器人視覺系統的硬件設計

本文結合視覺系統的優良性能和嵌入式控制系統的優點，以及uC/OS-II易移植、可固化、可裁剪的特點，提出并設計了一種應用于采摘機器人中嵌入式視覺系統，搭建了以視頻信號收集、視頻編碼器、視頻解碼器、Flash及復位等電路為基礎的硬件平臺。

2.1 采摘機器人視覺系統的總體方案設計

本文設計核心處理器采用TI公司最新研究設計的32位定點數字處理器芯片TMS320F2812，其數據處理能力超強，平均每秒可以執行150M條指令，且具有豐富的SARAM和Flash片內存儲資源。本文根據視覺系統的組成結構和DSP的工作特性，提出了基于DSP的嵌入式視覺系統。嵌入式視覺系統的總體方案設計如圖2所示。

圖2 嵌入式視覺系統的總體方案Fig.2 The general scheme of embedded vision system

該視覺系統對視頻信號的處理過程比較明顯：先從CCD攝像頭捕獲視頻信息，利用視頻解碼器對視頻信號進行解碼得到亮度參量和色度參量分開的像素信號，并送至TMS320F2812進行數據的處理；然后將處理得到的控制信號發送到采摘機器人的底層控制部分，同時將視頻信號處理結果傳輸至視頻編碼器，利用OSD顯示器顯示并監測整體系統的運行情況。

2.2 視頻解碼電路的設計

相比其他信號而言，視頻圖像信號比較復雜，包括行、場、時序等同步信號，因此對于視頻圖像信號的采集和處理非常復雜。視頻解碼電路采用TI公司的TVP5150，具有超低功耗的優點；采用四面32腳封裝，含轉換的NTSC/PAL/SECAM等格式的高性能視頻解碼器，其正常工作時功耗僅115MW，比較適合便攜使用、并且要求嚴格的視頻產品。TVP5150芯片僅需采用14.318 18MHz晶振作為輸入時鐘，數字和模擬輸入電壓為1.8V，IO輸出輸出口電壓為3.3V；信號輸入采取阻抗匹配設計，防止對輸入信號有所反射。TVP5150視頻解碼電路如圖3所示。攝像機將采集到的模擬信號經過TVP5150進行解碼，然后將解碼后得到的數字視頻信號發送至顯示屏幕。若解碼芯片工作正常，則可以看到顯示設備上對應的顯示畫面。該解碼電路將模擬復合視頻信號解碼成符合ITU-RBT.656標準的數字視頻信號輸出，方便TMS320F2812處理器進行數字視頻信號輸出，容易進行數字視頻圖像去隔行、分辨率轉換甚至MPEG編碼等處理；通過TVP5150完成芯片初始化設置。

圖3 TVP5150視頻解碼電路Fig.3 TVP5150 video decoding circuit

2.3 視頻編碼電路的設計

模擬視頻信號轉化為數字信號后，Y和UV信號需要在準確相同的時序下才能重新疊加復合為視頻信號輸出。通常來說，視頻編碼電路的設計過程比較復雜，主要包括濾波、調節色彩、添加時鐘信號，以及進行數模信號的轉化等。本文選用SAA7105對視頻圖像進行處理后輸出，該芯片集成度高，內部包括輸入信號格式器、彩色空間轉換器、高質量的定標器和抗抖動式濾波器，可以在低電壓模式下輸出圖像處理信號，被處理的視頻信號經過低通濾波后編碼為模擬信號。SAA7105顯示接口電路如圖4所示。

圖4 SAA7105顯示接口Fig.4 SAA7105 display interface

3 視覺系統開發平臺—實時操作系統

本文設計的軟件開發平臺采用uC/OS-II系統，采摘機器人視覺系統利用uC/OS-II內核實現智能控制功能。

3.1 采摘機器人視覺系用軟件總體設計

控制系統的硬件部分是機器視覺系統正常運作的平臺，而硬件部分的協調運行必須依靠底層程序驅動。嵌入式視覺系統軟件總體設計如圖5所示。

圖5中，整個軟件的設計包含以下幾個部分：①CCD攝像機采集一組視頻信號；②對視頻信息進行預處理；③將預處理后的圖像信息送入顏色分類器中進行顏色分割，得到二值化圖像；④利用圖像處理算法識別二值化圖像，獲取目標的二維坐標信息；⑤編碼器恢復原圖像，將信息送到控制系統；⑥將處理結果傳送至VAG顯示。

圖5 嵌入式視覺系統軟件設計框架圖Fig.5 Framework of software design for embedded vision system

3.2 uC/OS-II操作系統的移植

uC/OS-II是一種可自主剪裁、移植的系統，其內核程序相當少，移植可行性強，具有多任務、中斷管理和系統服務等特點，是專門為計算機的嵌入式應用設計的系統內核。對于一個處理器而言，要同時處理多個任務機制，必須使處理器具備一種在運行期內更加CPU運行的途徑；而在uC/OS-II中，每個運行任務都會有一個獨立的控制模塊，通過指針可以實現任務同時進行或者完成任務運行的切換。uC/OS-II操作系統移植主要包括下面幾個部分：

1)OS_CPU.H文件的移植；

2)INCLUDESH文件的移植；

3)修改OS_CFG.H配置文件；

4)修改OS_CPU_H.ASM文件；

5)修改OS_CPU_H.ASM文件；

6)修改啟動代碼。

其中，OS_CPU.H文件的移植的部分代碼如下：

typedef unsigned char BOOLEAN;

typedef unsigned char INT8U;

typedef signed char INT8S;

typedef unsigned short INT16U;

typedef signed short INT16S;

typedef unsigned long INT32U;

typedef signed long INT32S;

typedef float FP32;

typedef double FP64;

4 農業采摘機器人視覺識別系統的實現

視覺是動物獲取信息的重要手段，不只是采集光信號，還包括對采集到的信息進行處理及保存的全過程。因此，視覺識別系統是采摘機器人的核心，是整個智能控制系統的靈魂。CCD攝像機的成像原理為：利用CCD或 CMOS芯片感光后生成電信號，再把電信號轉化為數字信號，再通過獨特的算法把數字信號還原為圖像。攝像機的成像原理如圖6所示。

圖6 CCD攝像機的成像原理Fig.6 Imaging principle of CCD camera

一個物體的空間坐標確立實質是由視差值決定的，根據攝像機的連線距離與物體和攝像機的角度可以確定目標果實的視覺深度。根據圖6可得

(1)

(2)

(3)

其中，x、y、z分別是目標物體實際位置與攝像機的相對距離坐標。視覺識別系統處理圖像流程為：①圖像獲取；②圖像預處理；③圖像分割；④特征提取；⑤立體匹配；⑥目標定位。攝像機采集到的圖像經處理后輸送到處理器，在圖像定義的直角坐標系“u-O-v”，每一像素的坐標(u,v)分別是該像素在數組中的行數和列數，即(u,v)是以像素為單元的圖像坐標。

5 實驗結果

對成熟果實三維信息成功定位，是判斷采摘機器人性能是否優良的重要條件。本文以成熟蘋果為對象，在機器人自主運行的情況下，對目標物體的位置進行了測試實驗。視覺識別系統測量處理流程如圖7所示，采摘機器人測量的實驗結果表1所示。

從表1可以看出：處理后得到的結果與實際目標一致，采摘機器人測定目標果實的成功率較高，對單個目標果實的判定時間能控制在5s以內。實驗結果證明：該機器視覺識別系統測量效果非常好，可以實現對采摘機器人的監測和導航，并能夠提高整個機器視覺系統的運行速度。

圖7 視覺識別系統處理流程圖Fig.7 Visual identity system processing flow chart表1 采摘機器人的測量結果Table 1 Measurement results of picking robot

測量值/mm圓心X圓心Y半徑R實際值/mm圓心X圓心Y半徑R197115281951162813210027131992615812228158122281461182914711529136110251361082613214628130147292031242620412527149167251501662621013829209139302624513026345030

6 結論

隨著果蔬采摘作業的復雜化，人們對農業采摘機器人有了新的要求，希望其擁有更強的智能化能力，能夠輕松應對作業過程中各種突發的環境變化。因此，本文提出了基于視覺系統的農業采摘機器人，將視覺系統與自動化技術融合在一起，在DSP強大處理能力和uC/OS-II操作系統易于模塊化的基礎上，實現了采摘機器人的嵌入式視覺系統，并利用視頻算法對智能控制系統進行了探索式研究。該研究對采摘機器人提高前行過程中躲避障礙物和識別目標果實能力有著非常重要的積極作用，對農業實現機械自動化、無人化生產具有重要的實際應用意義。

[1] 田夢倩,羅翔.機器人視覺伺服系統結構及實現[J]. 制造業自動化,2005(12):40-42.

[2] 付中軍.果蔬采摘機器人視覺技術研究及系統構建[D].沈陽:沈陽工業大學,2014.

[3] 周洋.基于嵌入式系統的網絡視頻監控系統設計與實現[D].南京:南京航空航天大學,2007.

[4] 牛麗娟.嵌入式操作系統移植的可視化配置技術研究[D].南京:南京理工大學,2007.

[5] 付安新.基于DSP的嵌入式機器人視覺系統的設計與實現[D].杭州:浙江大學,2006.

[6] 戚利勇.黃瓜采摘機器人視覺關鍵技術及系統研究[D].杭州:浙江工業大學,2011.

[7] 呂繼東.蘋果采摘機器人視覺測量與避障控制研究[D].鎮江:江蘇大學,2012.

[8] 紀超.溫室果蔬采摘機器人視覺信息獲取方法及樣機系統研究[D].北京:中國農業大學,2014.

[9] 李占坤.果樹采摘機器人控制系統研究與設計[D].鎮江:江蘇大學,2010.

[10] 李佳旭.基于ARM7的嵌入式μC/TCP-IP協議棧的研究與實現[D].西安:西安電子科技大學,2010.

[11] 孫承庭,胡平.智能移動式水果采摘機器人設計—基于機器視覺技術[J].農機化研究,2016,38(8):179- 183.

[12] 王紅濤.基于視覺的工業機器人目標識別定位方法的研究[D].西安:西安理工大學,2007.

[13] 聶春鵬.基于雙目立體視覺的工業機器人目標識別及定位研究[D].西安:長安大學,2015.

[14] 任嬌.基于機器視覺的智能啤酒瓶污損檢測系統的研究與設計[D].曲阜：曲阜師范大學,2015.

[15] 蔡柏良.基于DSP56F826的uC/OS-Ⅱ移植與構件設計[D].蘇州：蘇州大學,2003.

[16] 宋健,孫學巖,張鐵中,等.開放式茄子采摘機器人設計與試驗[J].農業機械學報,2009(1):143-147.

[17] 趙慶波,趙德安,姬偉,等.采摘機器人視覺伺服控制系統設計[J].農業機械學報,2009(1):152-156.

[18] 呂強.柑橘采摘機器人工作場景信息感知技術與路徑規劃研究[D].鎮江:江蘇大學,2010.

[19] 丁亞蘭.基于機器視覺的獼猴桃果實識別與定位關鍵技術研究[D].楊凌:西北農林科技大學,2009.

[20] 缐曉林.基于Freescale i.MX27的視頻編解碼的研究與應用[D].北京:北京郵電大學,2010.

[21] 陳濤.基于ARM的電火花線切割機數控系統研究[D].南京:南京航空航天大學,2010.

[22] 王銳煌.基于FPGA的嵌入式視覺檢測系統及IP核設計[D].廣州：廣東工業大學,2011.

[23] 呂繼東,趙德安,姬偉,等.開放分布式蘋果采摘機器人控制系統研究及實現[J].小型微型計算機系統,2012(2):289-292.

[24] 呂繼東,趙德安,姬偉,等.蘋果采摘機器人對振蕩果實的快速定位采摘方法[J].農業工程學報,2012(13): 48-53.

[25] 孫立軍,令曉明. 基于機器視覺技術啤酒空瓶檢測系統設計[J].電子世界,2012(18):112.

[26] 楊永.用于采摘機器人的空間定位方法及試驗[J].制造業自動化,2014(23):49-52.

[27] 李國利,姬長英,翟力欣.果蔬采摘機器人末端執行器研究進展與分析[J].中國農機化,2014(5):231- 236,240.

[28] 陳軍.嵌入式家居視頻監控遠程控制的研究與實現[D].長沙:湖南大學,2013.

[29] 劉世與.基于目標跟蹤的全方位視覺自引導車動態定位技術[D].天津:天津理工大學,2008.

[30] 安鵬.基于ARM和uCOS-Ⅱ的衍射儀高壓控制系統研究與應用[D].西安:西安電子科技大學,2009.

[31] 楊文亮.蘋果采摘機器人機械手結構設計與分析[D].鎮江:江蘇大學,2009.

Design for Vision System of Picking Robot Based on DSP and uC/OS-II

Shen Yige, Jin Guo

(Henan Polytechnic Institute, Nanyang 473000, China)

In the rapid development of industrial automation and intelligence, machine vision as the core technology to improve the efficiency of production, and its in the United States, Germany, France, Russia and other developed countries have long been widely used. In recent years, the rapid development of domestic machine vision, China has become one of the most active areas of the technology development, and its widely used in industry, agriculture, aerospace, public security, transportation, security, and other industries. Because the visual system needs to process the video image information, the computation quantity is big, therefore the present system uses the computer system to carry on the construction. Based on the embedded in video image processing based on, the embedded visual system and combined with the application of thought, and the vision system and embedded intelligent system easy to characteristics of information integration. Design and research of the a vision system based on DSP and UC/OS-II. The scheme mainly includes hardware and software and operating system design. In this paper, on the vision system and the DSP embedded system to take a series of exploratory research, the method greatly improves the efficiency and automation of the production, to realize the visual system in picking robot application has important significance.

picking robot ； machine vision system; DSP; uC/OS-II

2016-03-03

河南省自然科學基金項目(2015GZC155);南陽市科技攻關項目(KJGG36)

申一歌(1982-)，女，河南南陽人，講師，碩士研究生，(E-mail)yuanzhu1982@hnpi.cn。

S225；TP391.41

A

1003-188X(2017)06-0223-05