雷鋒網按：本文為(wei) 雷鋒網專(zhuan) 欄，作者係佐思產(chan) 研研究總監周彥武，雷鋒網經授權發布。

基於(yu) 視覺係統的車道線檢測有諸多缺陷。

首先，視覺係統對背景光線很敏感，諸如陽光強烈的林蔭道，車道線被光線分割成碎片，致使無法提取出車道線。

其次，視覺係統需要車道線的標識完整，有些年久失修的道路，車道線標記不明顯，不完整，有些剛開通幾年的道路也是如此。

第三，視覺係統需要車道線的格式統一，這對按照模型庫識別車道線的係統尤其重要，有些車道線格式很奇特，比如藍顏色的車道線，很窄的車道線，模型庫必須走遍全國將這些奇特的車道線一一收錄，才能保證順利檢測。

再次，視覺係統無法對應低照度環境，尤其是沒有路燈的黑夜。一般LKW要求時速在72公裏以上才啟動，原因之一是速度比較高時人不會(hui) 輕易換道，另一個(ge) 原因就是比較低的車速意味著視覺係統的取樣點不足，擬合的車道線準確度較低。而激光雷達的有效距離一般是視覺係統的4-5倍，有效的采樣點比較多，車速較低時檢測準確度遠高於(yu) 視覺係統。

最後，如果車道線表麵被水覆蓋，視覺係統會(hui) 完全無效。視覺係統最大的優(you) 點就是成本低。因此自2008年後，學術界已經很少研究基於(yu) 視覺係統的車道線檢測，轉而利用激光雷達檢測車道線，激光雷達可以解決(jue) 上述所有問題，包括車道線被水覆蓋，激光雷達最大可穿越70米的水深。

激光雷達唯一的缺點就是成本太高。

基於雷達掃描點密度的車道線檢測

早期激光雷達檢測車道線是基於(yu) 雷達掃描點密度的車道線檢測方法，該方法通過獲取雷達掃描點的坐標並轉換成柵格圖，用原始數據映射柵格圖，可以是直接坐標柵格圖也可以是極坐標柵格圖。

按照後期處理需要進行選擇，極坐標柵格圖被直接用於(yu) 車道線識別，即有多個(ge) 點映射的柵格就被認為(wei) 是車道線點，該識別方法對特征提取的要求很高，且受距離影響嚴(yan) 重，因為(wei) 極坐標柵格距離越近柵格精度越高，車道線識別的精度越高，距離越遠柵格精度越低導致識別車道線的精度就越低然後利用柵格圖中點的密度提取車道線。

對於(yu) 點密度的求取可以采用直方圖統計的方式，通過直方圖統計點密度快捷直觀，容易理解。由於(yu) 基於(yu) 掃描點密度的檢測方法沒有很複雜的中間過程，所以實時性高，在快速檢測中受到大家的青睞。

但是該方法隻獲取了掃描點的位置信息，對於(yu) 雷達反饋的其他信息都沒有進一步分析，容易把一些與(yu) 車道線掃描點密度類似的道路信息混進車道線檢測結果中；或者在車道線與(yu) 其他障礙物靠近或重合時，無法區分出障礙物和車道線，他們(men) 隻能被當作一個(ge) 整體(ti) 保留或剔除。

所以此方法的抗幹擾能力差，容易出現誤檢。這種方法目前已經不常使用。

激光雷達檢測車道線的四種方法

目前激光雷達檢測車道線主要有四種方法：

• 基於(yu) 激光雷達回波寬度；

• 基於(yu) 激光雷達反射強度信息形成的灰度圖，或者根據強度信息與(yu) 高程信息配合，過濾出無效信息；

• 激光雷達SLAM與(yu) 高精度地圖配合，不僅(jin) 檢測車道線還進行自車定位；

• 利用激光雷達能夠獲取路沿高度信息或物理反射信息不同的特性，先檢測出路沿，因為(wei) 道路寬度是已知，根據距離再推算出車道線位置。對於(yu) 某些路沿與(yu) 路麵高度相差低於(yu) 3厘米的道路，這種方法無法使用。

後三種方法需要多線激光雷達，最少也是16線激光雷達。前者可以使用4線或單線激光雷達，考慮到奧迪A8已經開始使用4線激光雷達，4線激光雷達已經進入實用階段。

當然，這四種方法也可以混合使用。

車道線檢測兩步走

車道線檢測基本分兩(liang) 部走：提取幾何或物理特征，利用離散數據擬合成車道線。無論是視覺還是激光雷達，通常都是用最小二乘法擬合車道線。

離散數據擬合車道線

Ibeo是最適合第一種方法的激光雷達。Ibeo的激光雷達特有三次回波技術。每點激光返回三個(ge) 回波，返回信息能夠更加可靠地還原被測物體(ti) ，同時能夠精確分析相關(guan) 物體(ti) 數據，並能識別雨、霧、雪等不相關(guan) 物體(ti) 的數據。

如圖所示，其中W表示回波脈衝(chong) 寬度，d表示掃描目標的距離。反射率作為(wei) 物體(ti) 的固有屬性，受物體(ti) 材質、顏色等的影響，能夠很好地反映物體(ti) 特征，不同顏色。

密度的物體(ti) 的反射率都有一定的差異，物體(ti) 反射率決(jue) 定Ibeo回波脈衝(chong) 寬度特性，路麵和車道線有著明顯的差異，所以可以利用回波脈衝(chong) 寬度的差異對目標進行區分。

很明顯，路麵的回波寬度在2米左右，車道線的回波寬度在4米左右。

根據Ibeo的特性知道其垂直方向上的掃描角度為(wei) 3.2度，共分四層掃描，即每層0.8度，在Ibeo水平安裝的情況下，並考慮到實際情況一一Ibeo的高度受車體(ti) 的限製，其下麵兩(liang) 層(一、二層)主要返回道路表麵的信息，而上麵兩(liang) 層(三、四層)主要返回有一定高度的道路信息。

根據激光雷達的特性知道激光束掃描到物體(ti) 會(hui) 立即產(chan) 生回波，一二兩(liang) 層的掃描距離遠小於(yu) 三四兩(liang) 層。

通過理論分析和實驗驗證可知一二兩(liang) 層返回的信息主要包括路麵、車道線、少量障礙物和邊界數據；三四兩(liang) 層主要返回道路邊界、障礙物和少量路表信息，所以在特征種子點提取階段需要重點分析一二兩(liang) 層的雷達數據，這部分數據中對於(yu) 車道線檢測最大的幹擾在於(yu) 路麵，提取車道線種子點特征的重點就是分離車道線特征與(yu) 路麵特征。

最小二乘法擬合車道線

通過最小類內(nei) 方差算法找到路麵與(yu) 車道線的分割閾值，利用誤差分析原理剔除車道線集合範圍內(nei) 的粗大誤差，即剔除幹擾信息，提取出車道線特征種子點。然後再擬合成車道線。

最小類內(nei) 方差是一種自適應閾值的求取方法，也是一種模糊聚類方法。其基本思想是使用一個(ge) 閾值將整體(ti) 數據分成兩(liang) 個(ge) 類，因為(wei) 方差是數值分布是否均勻的度量，兩(liang) 個(ge) 類的內(nei) 部的方差和越小則每一類內(nei) 部的差別就越小，那麽(me) 兩(liang) 個(ge) 類之間的差別就越大。

如果存在一個(ge) 閾值使得類內(nei) 方差和最小則說明這個(ge) 閾值就是劃分兩(liang) 類的最佳閡值，使用最佳閾值劃分意味著劃分兩(liang) 類出現偏差的概率最小。

通過回波脈衝(chong) 寬度利用最小類內(nei) 方差算法建模分割車道線特征與(yu) 路麵特征，剔除車道線特征提取的最大幹擾。對回波脈衝(chong) 寬度進行統計分析，並劃分脈衝(chong) 寬度級別，因為(wei) 直接使用脈衝(chong) 寬度值其分布不利於(yu) 統計，采用對脈衝(chong) 寬度平均區域劃分即脈衝(chong) 寬度級，統計各級內(nei) 的點數，從(cong) 而得到回波脈衝(chong) 寬度分布直方圖。再利用諸如模糊聚類分析方法剔除幹擾值。

最小二乘法近似求解不斷優(you) 化靠近真實值的數學方法，它可以利用己知數據簡便地求得未知數據，並不斷優(you) 化保證求得的數據與(yu) 真實數據問的誤差的平方和最小。

利用最小二乘法擬合曲線，就是不斷優(you) 化求取某條曲線使其最能體(ti) 現已有數據點的變化趨勢，具體(ti) 過程是利用已知的數據點優(you) 化求取最優(you) 的未知數據合成一條最佳的曲線，並保證已有數據點到曲線的距離的平方和最小。

也就是說，曲線擬合不要求近似曲線過所有數據點，隻需要己知的數據點都距離在這條曲線的不遠處，即這條曲線能反映數據點的整體(ti) 分布，又不至於(yu) 出現較大的局部波動，已知數據與(yu) 曲線的偏差的平方和達到最小就能有效控製波動。

簡而言之，最小二乘法擬合就是利用最小化誤差的平方和求取數據的最佳函數匹配。

基於(yu) 激光雷達反射強度信息

根據反射強度值做的車道線檢測，在車載激光雷達獲取的道路周圍環境點雲(yun) 數中，可以輕鬆區分出道路與(yu) 車道線。

具體(ti) 到車載激光雷達獲取的道路周圍環境三維點雲(yun) 數據中，可以看作一個(ge) 局部均值變點模型，每一激光層采集的可行駛區域內(nei) 回波強度值就是一組輸出序列，其回波強度值變化的點就是所要求的車道標線點集。

現在隻須在每一激光層采集的可行駛區域內(nei) 回波強度值輸出序列中檢測是否有變化點，若存在則標記並提取這些變點。基於(yu) 車載雷達獲取的智能車感興(xing) 趣區域內(nei) 海量點雲(yun) 數據中的T坐標值有一定高程特點進行濾波，確定可行駛區域進而剔除與(yu) 車道標線回波強度值相近的障礙物。

*上圖為(wei) 簡單濾波後粗提取的車道線回波強度值投影圖（全局圖）

由於(yu) 車載激光雷達獲取的道路周圍環境點雲(yun) 數據是分層存儲(chu) 的，不同激光層獲取的道路周圍環境點雲(yun) 數據相鄰兩(liang) 點間距與(yu) 到雷達坐標係原點的距離有關(guan) 。

距離越遠間距越大，考慮到安裝在正常行駛上的激光雷達獲取的車道標線曲率變較小，所以利用文獻提出的基於(yu) 車道標線方向的EM最大期望聚類算法對粗提取車道標線點雲(yun) 數據進行聚類。

通過在聚類過程中估計車道標線方向來對粗提取的車道標線點雲(yun) 數據集進行分類去噪。然後再利用最小二乘法進行車道線擬合。

再來看先檢測路沿，再根據路寬推測車道線的方法。

激光雷達通過以太網與(yu) 計算機連接，點雲(yun) 數據以 UDP 的方式進行發送。激光雷達的數據通過兩(liang) 個(ge) 端口發送出來，端口 2368 負責發送點雲(yun) 數據，端口 8308 發送 GPS 數據還有位置數據。根據廠商提供的數據包格式說明，每個(ge) 數據包包含有效數據的載荷以及狀態數據。

一個(ge) 數據包集合 12 次發射接收到的所有數據，接收到的距離以及強度信息是按照錯開的順序進行接收的（ 0， 16， 1， 17， 2， 18...15，31）。

根據數據包的格式，進行相應的接收和存儲(chu) 。點雲(yun) 數據包含到一束激光點達到反射點反饋到的距離信息、強度信息以及偏轉角度，由此可以得到反射點到激光雷達中心的距離、垂直平麵上的角度以及水平麵上的角度。

若使用車輪與(yu) 地麵接觸的四個(ge) 點所在的平麵作為(wei) 空間直角坐標係的 xOy 平麵，通過激光雷達中心所在位置並且垂直於(yu) xOy 平麵的一條直線作為(wei) z 軸，由此便構成了如圖的空間坐標係。

利用點雲(yun) 數據， distance 表示激光點到激光雷達中心的直線距離，α是垂直方向上的夾角， β是水平方向上的夾角。

由於(yu) 雷達內(nei) 部發射器之間存在偏差（如圖 3-(b)），需要進行內(nei) 部校 正 ， calibration_x 、 calibration_y 以 及calibration_z 分別為(wei) 在 xyz 方向上所對應的內(nei) 部校正參數，通過公式求得每個(ge) 點在空間中的坐標（ x, y, z）。

依次遍曆每一個(ge) 數據點，就可以完成對激光雷達數據的解析，利用接收到的數據重構出 3D點雲(yun) 。多線激光雷達采集到的 3D 點雲(yun) 數據能夠提供了大量的信息，但是處理這些數據也帶來了巨大的運算量，這是造成許多基於(yu) 多線激光雷達的算法實時性比較差的重要原因。

劃分網格提升激光雷達實用性與可用性

因此，減少運算量是提升多線激光雷達的實時性與(yu) 可用性的關(guan) 鍵。對於(yu) 這個(ge) 問題，通過劃分網格的方法，減少運算量。

一種網格是方框型，一種是扇形。

方形網格是以激光雷達的位置（或者說車體(ti) 位置為(wei) ）地圖中心，將激光雷達周圍的環境劃分為(wei) 大小相等的網格。進行方形網格劃分之後，將解析雷達數據得到的 3D點雲(yun) 投影到網格當中。扇形網格是以激光雷達的位置為(wei) 圓心，用不同的半徑的同心圓將激光雷達周圍的環境進行劃分。

一個(ge) 網格是由同心圓以及從(cong) 圓心出發的射線組成如圖中的紅色部分。因為(wei) 激光雷達可以測量的最大範圍可以到達 80 米到 100 米，所以設置最大的一個(ge) 同心圓的半徑為(wei) 80 米，最小的同心圓的半徑為(wei) 0.5米， 相鄰同心圓半徑差作為(wei) 一個(ge) 參數，將 3D點雲(yun) 中的每個(ge) 點投影到網格當中。

基於(yu) 方形網格的劃分，將全圖分割為(wei) 大小相同的網格，對於(yu) 遠近的障礙物處理比較公平；缺點是運算量大。基於(yu) 扇形網格進行劃分，呈現近處網格小而密集，從(cong) 圓心開始越往外，網格越大。

扇形網格的優(you) 勢在於(yu) 對於(yu) 近處的障礙物有良好的精度，能夠分辨較小的障礙物，在減少運算量的同時對障礙物的處理有所側(ce) 重，缺點在於(yu) 可能無法識別遠處的較小的障礙物。

利用激光雷達獲取路沿高度信息或物理反射信息

常見的路沿有人行道的路沿石、綠化帶、隔離柵欄、雪糕桶等，除此之外，道路環境中，常見的障礙物還有路燈、行道樹、消防栓、垃圾桶等。因此，路沿識別，需要找到人行道、綠化帶、隔離柵欄、雪糕桶這類物體(ti) 。

道路環境中的物體(ti) 的高度大致可以分為(wei) 三個(ge) 層次，路燈、行道樹等物體(ti) 高度分類為(wei) 高，綠化帶、隔離柵欄、雪糕桶、消防栓等物體(ti) 高度分類為(wei) 中，人行道旁邊的路沿石的高度則劃分為(wei) 低。

因此將高度作為(wei) 篩選路沿的第一個(ge) 特征但是，如果直接使用每個(ge) 點的高度信息，接下來做聚類處理時會(hui) 產(chan) 生巨大的運算量，因此在上一步進行網格劃分之後，就可以將點的聚類轉為(wei) 對網格的聚類。

由於(yu) 網格的數量遠遠小於(yu) 點的數量，因而可以大大減少聚類所需要的運算量。因此要將點的高度信息映射為(wei) 網格的高度信息。

完成高程信息統計以後， 會(hui) 出現一個(ge) 明顯的問題：行道樹會(hui) 有一些樹枝延伸到道路上，此時，高程信息會(hui) 顯示路上有障礙物，實質上由於(yu) 樹枝是懸空的，並不會(hui) 阻礙汽車的正常的行駛，因此，需要對這一類誤判的障礙物進行中空識別，並將這一部分重新劃分為(wei) 可行駛區域。

算法的思路是，遍曆每個(ge) 標定為(wei) 障礙物的網格，檢測網格內(nei) 的點的高度分布， 如果在地麵以上 10cm（障礙物高度） 至地麵以上 2.4 米（激光雷達的頂端距離地麵的高度）之內(nei) 的點進行統計，如果數量少於(yu) 10%，則認為(wei) 該網格是中空的障礙物網格，車輛能夠正常通過，因此重新將該網格歸為(wei) 可通行區域。

在高度信息統計,給每一個(ge) 網格維護一個(ge) 標誌位，該標誌位用來指示網格是否符合常見路沿的高度限製要求。

如果滿足，則該標誌位為(wei) 真，否則為(wei) 假。完成了所有的障礙物高度信息統計以後，也就是對所有的網格都進行了標記，此時考慮路沿的第二個(ge) 特征：在一段距離內(nei) 維持相似高度。

隻滿足路沿的第一特征的物體(ti) 可能會(hui) 是消防栓、路過的小孩和垃圾箱等物品，因此需要路沿的第二個(ge) 特征進行進一步區分，將鄰近網格聚類成群落，當群落中的網格的數量大於(yu) 路沿的連續閾值時，才能認為(wei) 是路沿。

聚類流程如圖所示，遞歸地搜索所有網格， 直到周圍沒有新的可聚類網格就終止。 如果一個(ge) 標誌位為(wei) 真的網格的鄰近網格的標誌位同樣為(wei) 真，就將它放入集群當中。進行群落檢查的時候，如果群落中的網格數大於(yu) 設定的閾值，則可認為(wei) 是路沿。

我國高速公路設計標準為(wei) ， 車道寬度 3.75米，應急車道為(wei) 2.5 米。如圖所示， L1 為(wei) 激光雷達檢測的車體(ti) 到左側(ce) 路沿的距離， L2 為(wei) 激光雷達檢測的車體(ti) 到右側(ce) 激光雷達的距離，

設道麵總寬度 L， 則 L 可由公式得到:L = L1 + L2 。考慮到並非所有的所有道路均設置緊急車道，使用求模運算進行估計，設餘(yu) 數為(wei) M，則餘(yu) 數M 可由公式得到：M = L % 3.75。

如果 M 約等於(yu) 2.5，則認為(wei) 存在應急車道，否則認為(wei) 不存在。若存在時，路麵寬度由公式L = L − 2.5，設車道數為(wei) N，使用路麵寬度除以 3.75，並向下取整，因為(wei) 在道路設計中，路麵與(yu) 路沿之間存在一小段距離，則車道數可有公式N = ⌊L⁄3.75⌋計算出，根據車道數即可劃分出車道線，車道線的寬度一般為(wei) 15-20厘米。

由於(yu) 車道與(yu) 路沿的距離長短不一，因此這種方法在非標準道路上準確度不高，倒是路沿的檢測準確度比較高。

小結

未來固態激光雷達也很適合檢測車道線，固態激光雷達的FOV比較窄反而是個(ge) 優(you) 勢，等於(yu) 過濾掉了很多無關(guan) 數據。

不過單光子激光雷達通常采用計數器的方式讀出數據，不能檢測回波強度或回波寬度，不能檢測車道線。線性APD固態激光雷達就很合適。