劉昌輝，帥考,楊維榮

武漢工程大學(xué)計(jì)算機(jī)科學(xué)與工程學(xué)院，湖北 武漢 430205

嵌入式視覺的測(cè)距系統(tǒng)設(shè)計(jì)

劉昌輝，帥考,楊維榮

武漢工程大學(xué)計(jì)算機(jī)科學(xué)與工程學(xué)院，湖北 武漢 430205

行車操作人員在實(shí)際操作過程中，會(huì)出現(xiàn)對(duì)與之相鄰障礙物之間的距離太近而不能及時(shí)規(guī)避情況，導(dǎo)致碰撞事故的發(fā)生.針對(duì)這一問題，筆者構(gòu)建了以ARM11微處理器為核心，以USB攝像頭為圖像采集設(shè)備的測(cè)距系統(tǒng)，在基于機(jī)器視覺和圖像處理的基礎(chǔ)上，將單目視覺和激光技術(shù)相結(jié)合，考慮對(duì)應(yīng)點(diǎn)匹配和單個(gè)特征點(diǎn)提取誤差對(duì)測(cè)量結(jié)果影響，將激光點(diǎn)作為特征點(diǎn)的單目視覺測(cè)距的方法.實(shí)驗(yàn)結(jié)果表明，該系統(tǒng)能有效的測(cè)量與障礙物的距離，測(cè)量準(zhǔn)確，可靠性高且滿足實(shí)時(shí)性要求.

嵌入式；機(jī)器視覺；圖像處理；單目測(cè)距

0 引言

隨著工業(yè)生產(chǎn)蓬勃發(fā)展，行車作為起吊搬運(yùn)的重要設(shè)備，被廣泛應(yīng)用于各種工業(yè)現(xiàn)場(chǎng)，由于繁重的操作任務(wù)，操作人員往往注重于重物的運(yùn)行，而對(duì)與之相鄰障礙物的安全距離不能及時(shí)預(yù)判，導(dǎo)致相撞的事故時(shí)有發(fā)生.為了避免事故的發(fā)生，使行車能夠平穩(wěn)、安全、有效的運(yùn)行，行車的防撞技術(shù)成為目前國(guó)內(nèi)外的重要研究方向.

防撞系統(tǒng)中最基本和最關(guān)鍵的技術(shù)是距離檢測(cè)，目前運(yùn)用在障礙物檢測(cè)上的測(cè)距方式主要有紅外線測(cè)距、激光測(cè)距、超聲波測(cè)距、毫米波雷達(dá)測(cè)距以及視覺測(cè)距等多種方法，如姜海嬌建立的激光雷達(dá)測(cè)距系統(tǒng)根據(jù)測(cè)距特性對(duì)測(cè)量精度進(jìn)行研究［1］，沈燕等人介紹的基于單片機(jī)的超聲波測(cè)距設(shè)計(jì)實(shí)現(xiàn)測(cè)距功能［2］，劉鑫等人采用雷達(dá)測(cè)距實(shí)現(xiàn)倒車防撞控制等［3］，都在一定程度上滿足了防撞要求.然而這幾種測(cè)距方式都有其局限性，紅外線測(cè)距響應(yīng)時(shí)間長(zhǎng)，使操作人員得到的提前預(yù)警不足以躲避碰撞；激光測(cè)距成本較高，且對(duì)傳感器表面光潔度要求也較高；超聲波測(cè)距易受到空氣密度、溫度等影響，產(chǎn)生較大誤差；雷達(dá)測(cè)距易受到電磁波干擾等，限制了其在防撞系統(tǒng)中的應(yīng)用.

伴隨著圖像處理技術(shù)和嵌入式的不斷發(fā)展，視覺測(cè)距為安全車距檢測(cè)提供了一種更有效的解決方案.本文在ARM11開發(fā)平臺(tái)基礎(chǔ)上實(shí)現(xiàn)了單目視覺測(cè)距功能，通過以目標(biāo)物體上激光點(diǎn)為特征點(diǎn)，對(duì)激光點(diǎn)進(jìn)行識(shí)別定位，以達(dá)到對(duì)目標(biāo)物體進(jìn)行測(cè)距定位的目的.經(jīng)實(shí)驗(yàn)證明，該系統(tǒng)測(cè)距精度較高，實(shí)時(shí)性好.

1 硬件結(jié)構(gòu)設(shè)計(jì)

嵌入式視覺測(cè)距系統(tǒng)主要由嵌入式開發(fā)板、Linux操作系統(tǒng)、圖像處理模塊及單目視覺測(cè)距算法組成.本視覺測(cè)距系統(tǒng)中，采用一個(gè)USB接口的CMOS攝像頭作為圖像采集設(shè)備，考慮到ARM11具有的高性能、低功耗和低價(jià)格等特點(diǎn)，本系統(tǒng)選用ARM11的S3C6410處理器為控制核心，為軟件系統(tǒng)的運(yùn)行提供硬件支持.其具體硬件構(gòu)成如下：

（1）S3C6410是一個(gè)16／32位的RISC微處理器，擁有強(qiáng)大的內(nèi)部資源和視頻處理能力，主頻為533 MHz，最高可達(dá)667 MHz.

（2）支持Mobile DDR和多種NAND FLASH.包括128M字節(jié)的Mobile DDR，以及1G字節(jié)的型號(hào)為K9G8G08U0A的NAND FLASH，用于存儲(chǔ)內(nèi)核代碼、應(yīng)用程序、操作系統(tǒng)和數(shù)據(jù)資料等.

（3）4個(gè)串口，包括了三個(gè)三線TTL電平串口和一個(gè)五線的RS 232電平串口.

（4）1個(gè)USB HOST插口，支持USB1．1協(xié)議，可插鼠標(biāo)、U盤等.

系統(tǒng)結(jié)構(gòu)框如圖1所示.

系統(tǒng)通過USB攝像頭采集圖像，然后將圖像信息傳送到S3C6410嵌入式處理器中進(jìn)行圖像處理，并將圖像在LCD顯示器上實(shí)時(shí)顯示.

圖1 系統(tǒng)結(jié)構(gòu)框圖Fig.1 System architecture

2 系統(tǒng)軟件設(shè)計(jì)

測(cè)距系統(tǒng)的硬件為基本功能和擴(kuò)展功能提供了扎實(shí)的基礎(chǔ)，軟件系統(tǒng)就是要充分利用硬件資源，實(shí)現(xiàn)系統(tǒng)的穩(wěn)定運(yùn)行，是整個(gè)系統(tǒng)的重要組成部分.軟件部分的設(shè)計(jì)主要有建立交叉編譯環(huán)境；Bootloader的移植；Linux操作系統(tǒng)和相關(guān)驅(qū)動(dòng)的移植；圖像采集、處理和顯示.本文基于Qt／Embedded實(shí)現(xiàn)圖像顯示界面.

圖像的采集采用了于ARM11開發(fā)板中外接USB攝像頭，并在Linux內(nèi)核加載了USB驅(qū)動(dòng)和Video4Linux2（簡(jiǎn)稱V4L2）.V4L2是Linux內(nèi)核中關(guān)于視頻設(shè)備的內(nèi)核驅(qū)動(dòng)，本系統(tǒng)中為USB攝像頭提供統(tǒng)一的編程接口.系統(tǒng)在實(shí)現(xiàn)圖像采集時(shí)，首先通過調(diào)用函數(shù)open（“/dev/video0”，O＿RDWR）打開視頻設(shè)備，然后進(jìn)行圖像采集的參數(shù)初始化，申請(qǐng)圖像采集的幀緩沖區(qū)，并將這些幀緩沖區(qū)從內(nèi)核空間mmap（）映射到用戶空間，通過在隊(duì)列中循環(huán)輸入輸出幀緩沖區(qū)的數(shù)據(jù)完成圖像的采集.圖2描述了整個(gè)系統(tǒng)圖像采集的主要流程.

圖2 視頻采集流程圖Fig.2 Flow chart of video capture

嵌入式系統(tǒng)的應(yīng)用開發(fā)是在PC機(jī)上完成的，在PC機(jī)上運(yùn)行調(diào)試應(yīng)用程序，再將程序編譯成二進(jìn)制代碼，使程序可以在ARM11開發(fā)平臺(tái)上運(yùn)行.系統(tǒng)中選用的圖形用戶界面是具有可移植性好和支持多個(gè)GUI平臺(tái)交互開發(fā)特點(diǎn)的Qt／Embedded，所以除了在PC機(jī)上移植Qt／Embedded之外，還必須安裝在ARM11開發(fā)板中.當(dāng)一個(gè)Qt／Embedded應(yīng)用程序在開發(fā)板中能穩(wěn)定運(yùn)行時(shí)，開發(fā)過程才結(jié)束.操作人員可以通過圖形界面直觀的看到攝像頭采集到的圖像信息和與被測(cè)目標(biāo)之間的距離信息.Qt／Embedded的軟件開發(fā)流程如圖3所示.

圖3 測(cè)距系統(tǒng)的顯示流程圖Fig.3 Display flow chart of ranging system

3 嵌入式視覺測(cè)距方法

基于單目視覺的測(cè)距方法是采用模擬人眼的方式，通過獲得豐富的環(huán)境圖像信息進(jìn)行測(cè)距［4-5］，該方法穩(wěn)定性高，實(shí)用性強(qiáng)，還能從圖片中獲得其它的很多信息，起到輔助駕駛的功能.但是該方法也存在算法復(fù)雜，計(jì)算量大等缺點(diǎn)，針對(duì)這些不足，本文提出了一種單目視覺基于特征點(diǎn)的測(cè)距算法，該算法減少了特征點(diǎn)數(shù)目，降低了計(jì)算量，大大增加了實(shí)時(shí)性.

該測(cè)距方法主要由激光光源和成像系統(tǒng)構(gòu)成，系統(tǒng)原理圖如圖4所示.

系統(tǒng)中設(shè)定激光束與攝像頭的中心光軸平行，當(dāng)激光源發(fā)出光束照射在障礙物表面時(shí)，會(huì)在障礙物表面形成一個(gè)光斑，在USB攝像頭中顯示.經(jīng)過圖像灰度化、平滑濾波和邊緣特征提取處理，對(duì)光斑圖像運(yùn)用圓擬合法進(jìn)行中心坐標(biāo)運(yùn)算后，可以得到激光點(diǎn)在圖像中的位置坐標(biāo)，只需獲得這個(gè)點(diǎn)在沿著y軸方向上的距離中心點(diǎn)的距離，根據(jù)三角測(cè)距原理，就可以計(jì)算出攝像頭與障礙物之間的距離.如公式（1）所示.

根據(jù)公式可知，距離D的運(yùn)算是以激光源與攝像頭之間的距離h和激光點(diǎn)與攝像頭軸線之間的夾角θ為已知的前提下計(jì)算的，其中h可以測(cè)量獲得，本設(shè)計(jì)中將攝像頭與激光源固定測(cè)得的高度差h為6．0 cm，夾角θ也可以根據(jù)公式（2）得出.

其中：pfc（number of pixel from center of focal plane）為焦平面激光點(diǎn)到中心的像素?cái)?shù)量；rpc（Radians per pixel pitch）表示為每個(gè)像素點(diǎn)的弧度；ro（Radian offset）為弧度補(bǔ)償，用于彌補(bǔ)對(duì)齊錯(cuò)誤，矯正數(shù)據(jù).

將θ帶入公式（1）中，可以將D表示為公式（3）所示.

式(3)中rpc和ro可以通過測(cè)量實(shí)際已知距離和在該距離上攝像頭獲取的圖像信息中激光點(diǎn)的位置信息來驗(yàn)算求出.本文中用于計(jì)算rpc和ro的校正數(shù)據(jù)如表1所示.

圖4 測(cè)距系統(tǒng)原理圖Fig.4 Schematic diagram of ranging system

表1 校正數(shù)據(jù)Table 1 The correction data

將校正數(shù)據(jù)分別代入公式（3）中可得出兩個(gè)方程式31＝6．0／tan（57rpc＋ro）和47＝6．0／tan（30rpc＋ro），然后計(jì)算分別得出rpc＝ 0．002 398 643 2，ro＝0．055 279 314.則求距離公式（3）中僅有pfc為未知數(shù)，若在不同距離情況下的圖像信息中分別求出pfc的值即可計(jì)算出當(dāng)前實(shí)際距離.

本系統(tǒng)軟件部分在Linux系統(tǒng)下開發(fā)，并將程序加載到硬件平臺(tái)上脫機(jī)運(yùn)行進(jìn)行實(shí)驗(yàn)驗(yàn)證，對(duì)障礙物距離檢測(cè)實(shí)驗(yàn)的數(shù)據(jù)如表2所示.

從總體上看，系統(tǒng)的測(cè)量值與實(shí)際值相差較小，且用作校正數(shù)據(jù)的距離，在系統(tǒng)中進(jìn)一步測(cè)量時(shí)，誤差很小，其他數(shù)據(jù)也基本穩(wěn)定在實(shí)際距離的一定范圍內(nèi)，能滿足系統(tǒng)設(shè)計(jì)要求.與傳統(tǒng)測(cè)距方法相比較，傳統(tǒng)單目視覺測(cè)量的數(shù)據(jù)誤差是隨著距離的增大而變化的，距離較小時(shí)尚能滿足系統(tǒng)要求，但當(dāng)距離越大時(shí)其誤差也越大，而本測(cè)距系統(tǒng)的實(shí)驗(yàn)數(shù)據(jù)中，當(dāng)距離逐漸增加時(shí)，測(cè)量誤差雖然在一定幅度內(nèi)變化，但仍具有較高的精度.

表2 障礙物距離測(cè)量數(shù)據(jù)Table 2 Obstacle distance measurement data

測(cè)量值出現(xiàn)誤差的主要原因是USB攝像頭實(shí)際采集圖像過程中的環(huán)境因素以及人為測(cè)量中的不準(zhǔn)確性，如校正數(shù)據(jù)中實(shí)際的距離的測(cè)量誤差及激光與攝像頭之間距離h的確定等.對(duì)于測(cè)距數(shù)據(jù)中校正數(shù)據(jù)的實(shí)際測(cè)量與其他的距離相比較，產(chǎn)生誤差的原因是系統(tǒng)近距離與遠(yuǎn)距離校正值間的差異，系統(tǒng)可在試驗(yàn)中選取不同距離內(nèi)的兩組實(shí)際值分別求取rpc和ro的值，再對(duì)這些rpc和ro值取平均值運(yùn)算，以減少系統(tǒng)測(cè)量誤差.

4 結(jié)語(yǔ)

本文以ARM11微處理器作為嵌入式處理器，以USB攝像頭作為圖像采集設(shè)備，視覺傳感器和激光技術(shù)來檢測(cè)行車與障礙物之間的距離，為了避免機(jī)器視覺中對(duì)應(yīng)點(diǎn)匹配引起的測(cè)量誤差和圖像處理及距離顯示的實(shí)效性問題，設(shè)計(jì)了一種單目視覺融合激光技術(shù)的測(cè)距系統(tǒng).與傳統(tǒng)的測(cè)距技術(shù)如紅外測(cè)距、激光測(cè)距等相比，具有良好的抗干擾性和低成本等優(yōu)勢(shì)，并且通過實(shí)驗(yàn)驗(yàn)證系統(tǒng)的測(cè)量值穩(wěn)定在實(shí)際距離的一定范圍內(nèi)，能實(shí)時(shí)有效準(zhǔn)確的檢測(cè)行車與障礙物之間的距離，具有良好的實(shí)用性.

致謝

本項(xiàng)目來源于武鋼集團(tuán)鍛造廠，方案設(shè)計(jì)和運(yùn)行維護(hù)都得到了他們的大力支持與協(xié)作，在此表示衷心的感謝！

［1］姜海嬌，來建成，王春勇，等．激光雷達(dá)的測(cè)距特性及其測(cè)距精度研究［J］．中國(guó)激光，2011，38（5）：234－240．

JIANG Hai－jiao，LAI Jiang－cheng，WANG Chun－yong，et al．Research on ranging property of laser radar and its range［J］．Accuracy Chinese Journal of Lasers，2011，38（5）：234－240．（in Chinese）

［2］沈燕，高曉蓉，孫增友，等．基于單片機(jī)超聲波測(cè)距儀設(shè)計(jì)［J］．現(xiàn)代電子技術(shù)，2012，35（7）：126－129．

SHEN Yan，GAO Xiao－rong，SUN Zeng－you，et al．Design of ultrasonic ranging instrument based on MCU［J］．Modern Electronics Technique，2012，35（7）：126－129．（in Chinese）

［3］劉鑫，朱靖玉．基于單片機(jī)的倒車?yán)走_(dá)設(shè)計(jì)［J］．電子設(shè)計(jì)工程，2012，20（1）：94－97．

LIU Xin，ZHU Jing－yu．Design of automobile reversing rader based on microcontroller［J］．Electronic Design Engineering，2012，20（1）：94－97．（in Chinese）

［4］WAHAB M N A，SIVADEV N，SUNDARAJ K.Target distance estimation using monocular vision system for mobilerobot［C］//In：Open system（ICOS）2011 IEEE conrerence on，IEEE，2011：11－15．

［5］韓延祥，張志勝，戴敏．用于目標(biāo)測(cè)距的單目視覺測(cè)距算法［J］．光學(xué)精密工程，2011，19（5）：1110－1117．

HAN Yan-xiang，ZHANG Zhi-sheng，DAI Min Monocular vision system for distance measurement based on feature points［J］．Optics and Precision Engineering，2011，19（5）：1110－1117．（in Chinese）

Design of distance measurement system based on ARM embedded vision

LIU Chang－h(huán)ui，SHUAI Kao，YANG Wei－rong
School of Computer Science and Engineering，Wuhan Institute of Technology，Wuhan 430205，China

In the actual operation by crane operator，there exists the situation that operator can not make avoiding action timely at distance between crane and adjacent obstacles，causing collision accident．Aimed at this collision problem，we established distance measurement system by ARM 11 and USB camera．On the basis of machine vision and image procession，considering the effect of corresponding point match and extraction deviation of single characteristic point on measurement result，we integrated laser technology into monocular vision and adopted the monocular vision method of distance measurement using single laser point．The test result indicates that this system can effectively measure the distance of obstacles with accurate measurement and high reliability，meeting real－time requirement．

embedded；machine vision；image procession；distance measurement by monocular

TP31

A

10.3969/j.issn.1674-2869.2015.04.014

1674-2869（2015）04-0065-04

本文編輯：陳小平

2015－04－07

劉昌輝（1965-），男，湖北襄陽(yáng)人，副教授，博士．研究方向：人工智能系統(tǒng)，計(jì)算機(jī)控制系統(tǒng)．