基于三維激光雷達(dá)的道路可通行區(qū)域分割提取方法＊

鄒斌 饒陽 侯獻(xiàn)軍 王科未

（武漢理工大學(xué)，現(xiàn)代汽車零部件技術(shù)湖北省重點實驗室 汽車零部件技術(shù)湖北省協(xié)同創(chuàng)新中心，武漢 430070）

基于三維激光雷達(dá)的道路可通行區(qū)域分割提取方法＊

鄒斌 饒陽 侯獻(xiàn)軍 王科未

（武漢理工大學(xué)，現(xiàn)代汽車零部件技術(shù)湖北省重點實驗室 汽車零部件技術(shù)湖北省協(xié)同創(chuàng)新中心，武漢 430070）

為實現(xiàn)無人駕駛車輛利用車載三維激光雷達(dá)提取道路可通行區(qū)域，提出了一種基于小波變換結(jié)合模糊線段擬合的道路分割提取方法。利用探測傾角聚類的方法分割激光雷達(dá)掃描線在地面上的投影，通過小波變換初步確定路沿和障礙物位置，再使用模糊線段的方法精確定位路沿和障礙物。試驗結(jié)果表明，該方法具有較高的精度與實時性。

1 前言

無人駕駛車輛是通過車載傳感系統(tǒng)感知道路環(huán)境，自動規(guī)劃行車路線并控制車輛到達(dá)預(yù)定目標(biāo)的智能汽車[1]。無人駕駛車輛通常裝有由激光雷達(dá)和攝像頭組成的傳感器系統(tǒng)，用于識別障礙區(qū)域和道路區(qū)域。基于機器視覺的檢測方法數(shù)據(jù)量大，可較好地對目標(biāo)進行分類與檢測，但機器視覺易受到外部環(huán)境的影響，激光雷達(dá)對外部干擾的魯棒性強，而且對縱向運動目標(biāo)的解析度高，測距范圍大、視野更廣。目前，三維激光雷達(dá)在無人駕駛車輛上得到了廣泛應(yīng)用[1]。現(xiàn)有的三維激光雷達(dá)道路分割算法通常將原始數(shù)據(jù)網(wǎng)格化或無向圖化。基于網(wǎng)格的道路分割算法將三維點云聚類到網(wǎng)格中，通過分析每個網(wǎng)格中的三維點云特性確定該網(wǎng)格的屬性。Kammel[2]提出一種基于網(wǎng)格中點云最大高度差的道路檢測方法；Himmelsbach等[3]將三維點云以極坐標(biāo)的形式網(wǎng)格化，分離道路與障礙物區(qū)域。此類方法使得原始數(shù)據(jù)細(xì)節(jié)大量丟失，檢測精度主要取決于網(wǎng)格大小，大量子網(wǎng)格內(nèi)無數(shù)據(jù)，造成存儲空間和處理時間的浪費?；跓o向圖的道路分割算法主要在每個數(shù)據(jù)點與相鄰點之間建立領(lǐng)域系統(tǒng)，使得對三維點云的處理轉(zhuǎn)化為圖像處理。Moosmann等[4]根據(jù)區(qū)域增長法分割點云圖像，得到道路區(qū)域；Montemerlo等[5]使用三維數(shù)據(jù)環(huán)之間的距離判斷單個三維點是否屬于地面區(qū)域。相比于網(wǎng)格算法，基于無向圖的算法保留所有原始數(shù)據(jù)，精度更高，但運算量大。本文提出一種新的算法，在滿足高精度要求的同時，處理掃描單線的運算速度快，可滿足實時性要求。

2 算法綜述

2.1 算法流程

本文采用16線Velodyne三維激光雷達(dá)VLP-16，安裝在車輛頂部。為分析道路區(qū)域連續(xù)性特征，首先剔除高度信息，將所有三維點云投影至地面，最終得到的可通行區(qū)域是該平面內(nèi)的部分區(qū)域。本文僅分析車輛前方的道路情況，受VLP-16的精度限制，距離過遠(yuǎn)處單線間隔過大，可能漏檢障礙物導(dǎo)致檢測失效。因此，僅保留原始三維數(shù)據(jù)中車輛前方20 m及左、右側(cè)各10 m的數(shù)據(jù)點，規(guī)定三維激光雷達(dá)所在點為（0,0），無人駕駛車輛前方為x軸正方向，某幀實際場景如圖1所示。

圖1 數(shù)據(jù)點云在地面上的投影

由圖1可知，路沿處及障礙物區(qū)域與可通行道路區(qū)域有明顯差異，每條掃描線在可通行道路區(qū)域光滑連續(xù)，在路沿處和障礙物區(qū)域呈斷開或折角狀態(tài)。將圖1進行人工特征標(biāo)記，結(jié)果如圖2所示。

圖2 道路分割人工標(biāo)記結(jié)果

圖2中人工標(biāo)記的矩形框為道路區(qū)域的障礙物車輛，線段加粗部分為路沿，多邊形框內(nèi)為理想的可通行區(qū)域，必須在此區(qū)域內(nèi)規(guī)劃軌跡。為得到該區(qū)域，需將每條掃描單線切割提取。據(jù)此，本文提出基于掃描單線的障礙物及路沿特征提取算法，流程如圖3所示。其中，三維激光雷達(dá)原始數(shù)據(jù)的預(yù)處理包括解析數(shù)據(jù)包、修正坐標(biāo)偏移、提取有效范圍內(nèi)的數(shù)據(jù)點等。

圖3 算法流程

2.2 掃描單線提取

VLP-16三維激光雷達(dá)垂直測量角度范圍為30°（-15°～15°），垂直方向角分辨率為2°，水平方向角分辨率為0.2°。將獲得的笛卡爾坐標(biāo)系下的點云數(shù)據(jù)轉(zhuǎn)換至球坐標(biāo)后，得到所有點的仰角值，理論上仰角值相差不小于2°的點屬于不同單線。依據(jù)仰角值由低到高聚類，不同點的仰角值相差足夠小（本文設(shè)為0.5°）時可認(rèn)為屬于同一單線。圖1中數(shù)據(jù)點經(jīng)過極坐標(biāo)（ρ,θ）變換聚類處理后得到若干個單線集，如圖4所示。極坐標(biāo)變換時，原點不變，x軸正方向?qū)?yīng)θ=0°方向，y軸正方向?qū)?yīng)θ=90°方向。

圖4 單線提取

提取單線后，將單線中數(shù)據(jù)點按照方位角逆時針排列，建立方位角序列與點到三維激光雷達(dá)中心距離的函數(shù)關(guān)系，如圖5所示。分析每條單線定位突變點并剔除不平滑的線段，再識別路沿，定位可通行的道路區(qū)域。

圖5 掃描線上點的方位角序列與距離的關(guān)系

3 道路分割提取

3.1 小波變換識別道路障礙物

掃描單線經(jīng)過小波變換后，利用小波系數(shù)進行描述，小波系數(shù)表現(xiàn)出原始信號的信息和特性，信息的局部特征可以通過處理小波系數(shù)改變?？疾煨〔ㄗ儞Q與信號突變性的關(guān)系，一般用小波變換后的模極大值在不同尺度上的衰減速度衡量信號的局部奇異性[6]。

若小波函數(shù)ψ（t）是連續(xù)的實函數(shù)，其衰減特性為：

式中，K和ε為常數(shù)。

式（1）表明小波函數(shù)具有快速衰減性。

信號f（t）∈L2（R）在區(qū)間I上存在一致Lipschitz指數(shù)α（-ε＜α≤1），則存在常數(shù)c＞0，使對任意a,b∈I，其小波變換滿足：

式中，（Wf）(a,b)為f的小波變換。

反之，如果對于某個α（-ε＜α≤1），f（t）∈L2（R）的小波變換滿足式（2），那么f在I上存在一致Lipschitz指數(shù)α。設(shè)t0為f（t）的突變點，則|（Wf）（a,b）|在b=t0處取得極大值，此時式（2）中的等號成立。

由式（2）可知，如果α＞-0.5，則小波變換的模極大值會隨尺度j的增大而增大，如果α＜-0.5，則小波變換的模極大值會隨尺度的增大而減小。所以，可通過小波變換的模極大值隨尺度的變化情況判斷信號突變點類型。

信號的突變點檢測是對原始信號在不同尺度上光滑處理，對處理后的信號的一階或二階導(dǎo)數(shù)進行極值點檢測[7]。對信號的光滑過程采用的光滑函數(shù)一般用θ（t）表示，常用Gaussian函數(shù)或者Coiflets函數(shù)。一般地，光滑函數(shù)滿足：

式中，θ（t）為Coiflets函數(shù)。

由卷積的性質(zhì)可得到：

式中，卷積f?θs（t）為平滑算子，表示f（t）經(jīng)過算子運算后的函數(shù)。

由此可知，小波變換（Wf）（s,t）=f?ψs(1)（t）與f?θs（t）的一階導(dǎo)數(shù)成正比，而（Wf）（s,t）=f?ψs(2)（t）與f?θs（t）的二階導(dǎo)數(shù)成正比，說明在選取光滑函數(shù)θs（t）后，原始信號的突變點可以通過檢測小波變換f?ψs(1)（t）和f?ψs(2)（t）的模極大值獲得。在實際應(yīng)用中，僅在1個尺度下檢測突變點常常很難確定突變點位置，所以需要進行多尺度檢測，只有在多個尺度上均為極值點的位置才能確定為突變點所在的準(zhǔn)確位置[8]。對于小波的多尺度分析，常常使用重構(gòu)的快速算法，即Mallat算法[9]。

將每條單線上的點與雷達(dá)中心的距離數(shù)據(jù)集作為Mallat算法的輸入，利用coif5小波對信號進行分解，得到細(xì)節(jié)信號，可知突變點包含在多尺度細(xì)節(jié)信號cD中，與原始信號突變點同步。選取包含車輛障礙、路沿信息以及墻壁障礙的單線（圖4中單線距離由近到遠(yuǎn)排列情況下的6號單線）分析，如圖6所示。

圖6 小波變換細(xì)節(jié)信號

根據(jù)不同尺度下的模極大值找到突變點以及路沿處光滑度較低的區(qū)域分割單線。其中障礙物邊界為突變點，通過小波變換可精確定位，實際道路由于路沿較矮，存在破損導(dǎo)致路沿處曲線突變程度不夠明顯，只能確定路沿范圍，本文采用模糊線段的方法精確定位路沿。

3.2 模糊線段擬合識別路沿

二維離散點集擬合模糊線段的參數(shù)可通過增量識別模糊線段寬度結(jié)合凸包絡(luò)邊界線獲取[10]。為了提高識別速度，根據(jù)試驗數(shù)據(jù)給定優(yōu)化的初始值。擬合識別算法流程為：

a.將掃描單線根據(jù)方位角序列輸入，逐點計算當(dāng)前點與序列中前一點的距離d。若d≥Td，則將前一點作為當(dāng)前模糊線段的終點，當(dāng)前點作為新一條模糊線段的起點，模糊線段在此處斷開；若d＜Td，則將該點添加進入前一點所在的模糊線段，重新計算上、下包絡(luò)平行直線并得到模糊線段寬度，如果該寬度大于設(shè)定的閾值Tσ，則將該點作為新的模糊線段的起點，前一個點作為上一條模糊線段的終點。

圖7 模糊線段概念示意

b.每條掃描單線完成模糊線段分割后，將相鄰2條模糊線段的包絡(luò)平行直線斜率差值小于閥值Te（經(jīng)驗值）且凹凸性相同的模糊線段歸并為同一條模糊線段，由此將多段較為平滑的模糊線段連成同一條曲線。

三維激光雷達(dá)每條掃描單線與雷達(dá)中心的距離不同，但具有相同的水平角分辨率，因此每條模糊線段的閥值Td與Tσ均為與模糊線段上點到雷達(dá)中心點之間的距離D（取模糊線段上所有點的平均值）相關(guān)的自適應(yīng)參數(shù)。VLP-16實際運行頻率為10 Hz，該頻率下三維激光雷達(dá)的角分辨率為0.2°，同一掃描單線上相鄰掃描點之間的距離理論上為0.2πD/180，閥值與該距離成正比，根據(jù)實際調(diào)試效果，本文中閾值使用經(jīng)驗值。圖4中單線距離由近到遠(yuǎn)排列情況下的1號單線經(jīng)模糊線段擬合后如圖8所示。

圖8 掃描單線模糊線段擬合結(jié)果

3.3 道路分割提取結(jié)果

經(jīng)過小波變換后，結(jié)合突變點之間線段點的高度信息剔除障礙物。將所有掃描單線分別通過模糊線段擬合的方式精確分割不同線段，道路兩側(cè)不平滑的點組成的模糊線段長度較短且不連續(xù)，舍去該部分后如圖9所示。

圖9 去除障礙物及兩側(cè)區(qū)域

在道路區(qū)域，掃描單線與雷達(dá)中心的距離隨方位角變化較為平緩，在多尺度小波變換下細(xì)節(jié)信號cD變化較小，根據(jù)此特征提取道路信息如圖10所示。

圖10 可通行道路區(qū)域

經(jīng)過多幀測試，本文提供的道路提取方法能在復(fù)雜場景下較平滑地提取道路曲線。校園道路上出現(xiàn)行人的可通行道路區(qū)域識別結(jié)果見圖11，校園道路上停放多個車輛的識別結(jié)果見圖12。

圖11 算法識別結(jié)果I

圖12 算法識別結(jié)果II

4 試驗結(jié)果

本文使用的無人駕駛試驗平臺如圖13所示，三維激光雷達(dá)安裝于汽車頂部，轉(zhuǎn)向、制動、油門通過電子機械改裝實現(xiàn)程序控制。道路分割提取算法在Ubuntu ROS操作系統(tǒng)上使用python實現(xiàn)，在車載電腦上運行。在校園道路上實測1 000幀，提取算法平均每幀耗時58 ms，單幀耗時最高72 ms，最低49 ms，低于三維激光雷達(dá)工作周期100 ms，滿足實時性需求。

為分析分割提取算法的可靠性，需驗證在連續(xù)多幀情況下每幀數(shù)據(jù)分割提取的準(zhǔn)確率R，將算法結(jié)果與人工標(biāo)記的真值進行量化對比：

式中，oi為每條掃描單線道路提取完整度，以提取長度占實際可通行道路長度的比值表示；ei為修正因子，若出現(xiàn)識別結(jié)果包含路沿或障礙物信息，則判定該條掃描單線識別失效；NA為每幀參與運算的掃描單線數(shù)目；Tw為布爾型數(shù)值，取1時表示該幀道路提取區(qū)域能夠規(guī)劃軌跡，取0時表示不能。

圖13 無人駕駛自主平臺

在校園道路實測1 000幀圖像的人工標(biāo)記結(jié)果中，有9幀無法進行軌跡規(guī)劃，主要原因在于道路凹凸程度較大，導(dǎo)致掃描單線多處斷開，斷開部分判定為障礙物，使前方道路無法通行。其余幀均不影響軌跡規(guī)劃，選取其中100幀計算分割提取的準(zhǔn)確率R，平均值為98.7%，分割提取效果滿足后續(xù)軌跡規(guī)劃要求。理論上，道路凹凸不平導(dǎo)致掃描單線提取不完整時可以增大模糊線段擬合中參數(shù)的閥值，但由于測試道路路沿較低，這會導(dǎo)致路沿處分割不夠準(zhǔn)確，圖14、圖15所示為連續(xù)2幀的提取情況。

圖14中存在2條掃描單線由于道路不平提取不夠完整的情況。無人駕駛車輛經(jīng)過不平坦道路，如果某一幀可通行區(qū)域提取不夠完整，但依然能夠規(guī)劃局部路徑，可減速行駛繼續(xù)更新掃描線數(shù)據(jù)，直至出現(xiàn)新的完整道路可通行區(qū)域。在路面較平坦時，本文提出的算法具有很好的穩(wěn)定性，路沿及障礙物識別準(zhǔn)確，路面可通行區(qū)域提取完整度高。

圖14 當(dāng)前幀提取效果

圖15 下一幀提取效果

5 結(jié)束語

本文主要通過小波變換結(jié)合模糊線段擬合的方法分析三維激光雷達(dá)掃描單線信息，提取道路可通行區(qū)域。試驗結(jié)果表明，該算法兼顧了高精度與良好的實時性，將道路可通行區(qū)域接入軌跡規(guī)劃模塊，通過校園道路實車測試，無人駕駛試驗車能夠在道路上自主避障行駛，具有良好的穩(wěn)定性與實時性。由于算法需要依據(jù)路沿信息提取道路區(qū)域，對無路沿道路以及多車道的情況存在局限性，需融合其他傳感器信息進一步完善無人駕駛算法。

1 段永利，侯蘊琦.無人駕駛汽車開辟新藍(lán)海市場.中國信息界，2016（4）：66～69.

2 陳慧巖.無人駕駛汽車概論.北京：北京理工大學(xué)出版社，2014.

3 Kammel S,Pitzer B.Lidar-based lane marker detection and mapping.IEEE Intelligent Vehicles Symposium，Eind?hoven，2008.

4 Himmelsbach M,Hundelshausen F V,Wuensche H J.Fast segmentation of 3D point clouds for ground vehicles.IEEE Intelligent Vehicles Symposium，La Jolla，2010.

5 Moosmann F.Interlacing Self-Localization,Moving Object Tracking and Mapping for 3D Range Sensors.Kit Scientific Publishing,2013.

6 張小飛，徐大專，齊澤鋒.基于小波變換奇異信號檢測的研究.系統(tǒng)工程與電子技術(shù)，2003，25（7）：814～816.

7 孫云蓮，劉敦敏.時頻分析與小波變換及其應(yīng)用.武漢大學(xué)學(xué)報：工學(xué)版，2003，36（2）：103～106.

8 刁彥華，王玉田，陳國通.基于小波變換模極大值的信號奇異性檢測.河北工業(yè)科技，2004，21（1）：1～3.

9 王明祥，寧宇蓉，王晉國.基于Mallat算法的一維離散小波變換的實現(xiàn).西北大學(xué)學(xué)報：自然科學(xué)版，2006，36（3）：364～368.

10 Debled-Rennesson I,Feschet F,Rouyer-Degli J.Optimal blurred segments decomposition in linear time.International Conference on Discrete Geometry for Computer Imagery，Poitiers，2005.

（責(zé)任編輯 斛 畔）

修改稿收到日期為2017年3月2日。

Research on Extraction Method of Travelable Road Region Segmentation Based on 3D Laser Radar

Zou Bin,Rao Yang,Hou Xianjun,Wang Kewei
（Hubei Key Laboratory of Advanced Technology for Automotive Components,Hubei Collaborative Innovation Center for Automotive Components Technology,Wuhan University of Technology,Wuhan 430070）

In this paper,a new method based on wavelet transform in combination with blurred segment fitting line for road surface segmentation is proposed for the unmanned vehicle using on-board 3D laser radar to extract travelable road region segmentation.The projection of the laser radar scanning line on the ground plane is segmented by the method of detecting the inclination and clustering.Using wavelet transform to determine the location of the road and obstacles,and then the blurred segment method is applied to accurately locate the road and obstacles.The test results show that the method has high accuracy and real-time performance.

Unmanned vehicles,3D laser radar,Road segmentation,Wavelet transform,Blurred segment

無人駕駛車輛 三維激光雷達(dá) 道路分割 小波變換 模糊線段

U471.15；TP391.4；TP27

A

1000-3703（2017）06-0017-07

國家自然科學(xué)基金項目（51405359）；武漢理工大學(xué)自主創(chuàng)新研究基金項目（2016-zy-031）。