TWI759137B

TWI759137B - 能夠降低環境雜訊的光達系統

Info

Publication number: TWI759137B
Application number: TW110108889A
Authority: TW
Inventors: 林似霖; 吳秉翰
Original assignee: 國立彰化師範大學
Priority date: 2021-03-12
Filing date: 2021-03-12
Publication date: 2022-03-21
Also published as: TW202235910A

Abstract

本發明提供一種能夠降低環境雜訊的光達系統，其包括一光學雷達及一處理模組。光學雷達自偵測環境中取得一點雲模型資料；以及處理模組係電性連接於光學雷達，處理模組包含有一鄰近點雲過濾單元以及一卡爾曼過濾單元，鄰近點雲過濾單元接收點雲模型資料並進行處理，以便輸出一個過濾模型資料，卡爾曼過濾單元接收過濾模型資料，以便過濾輸出一個低雜訊環境模型資料，藉以降低光達系統在惡劣環境中的環境雜訊。

Description

能夠降低環境雜訊的光達系統

本發明係有關於一種能夠降低環境雜訊的光達系統，其透過兩次演算法而過濾雜訊，以降低光達系統在惡劣環境中的環境雜訊。

按，先進駕駛輔助系統(Advanced Driver Assistance Systems；ADAS)，是近年來車廠積極發展的車輛技術之一，而ADAS的主要功能是為駕駛人提供車輛的行進情形與車外環境變化等相關資訊進行分析，且預先警告可能發生的危險狀況，讓駕駛人提早採取因應措施，避免交通意外發生。

然而，隨著ADAS的快速發展，越來越多的車廠也開始致力於發展自駕車，故自駕車勢嚴然為汽車產業的未來趨勢。

而光學雷達在自駕車上是不可或缺的重要元件之一，透過光學雷達能夠感測車輛外的環境狀況，惟光學雷達也是有使用上的限制，例如光學雷達會受到很多因素的影響，主要的影響有：光學雷達發射接收的雜訊、車輛移動造成的雜訊、環境雜訊等。

其中，環境雜訊包括從星體、地球、太陽、大氣、雲或者任何不應該有的輻射源照射到或反射到接收端上的訊號，此外惡劣天氣也是環境雜訊的一種，如大雨、下雪、濃霧等皆會使光學雷達回波的偵測能力大幅下降，致使光學電達因環境雜訊而產生誤判，舉例來說，在大雨或濃霧中，水滴可能被誤判為車輛前方的物體，使得車輛停止下來，因此如何改善光學雷達所面對的雜訊問題，係為本發明所欲解決課題之一。

為解決上述課題，本發明揭露一種能夠降低環境雜訊的光達系統，其利用兩次演算過濾惡劣環境中的雜訊，以避免惡劣環境影響光學雷達的感測準確度。

為達上述目的，本發明一項實施例中提供一種能夠降低環境雜訊的光達系統，其包括一光學雷達及一處理模組。光學雷達自偵測環境中取得一點雲模型資料；以及處理模組係電性連接於光學雷達，處理模組包含有一鄰近點雲過濾單元以及一卡爾曼過濾單元，鄰近點雲過濾單元接收點雲模型資料並進行處理，以便輸出一個過濾模型資料，卡爾曼過濾單元接收過濾模型資料，以便過濾輸出一個低雜訊環境模型資料。

於本發明另一實施例中，點雲模型資料包括一具有X軸、Y軸、Z軸的環境框架及位於環境框架內、外側的複數點雲，其中，超過環境框架外側一定距離的點雲忽略不計。

於本發明另一實施例中，鄰近點雲過濾單元於環境框架內、外側的範圍以複數個取樣圓進行點雲的取樣，且兩個相鄰的取樣圓局部交疊，當取樣圓範圍內所取得點雲數量大於一個臨界判斷數值時，則保留取樣圓。

於本發明另一實施例中，取樣圓具有一個取樣半徑，取樣半徑為 2公分。

於本發明另一實施例中，兩個相鄰的取樣圓之圓心距離介於1公分至3公分之間。

於本發明另一實施例中，臨界判斷數值為10個，當取樣圓範圍內的點雲數量少於臨界判斷數值時，點雲則當作雜訊被濾除。

於本發明另一實施例中，更包括一行車電腦、一定位模組及一電源供應器，係分別電性連接於處理模組。

藉此，本發明利用鄰近點雲過濾單元以及卡爾曼過濾單元依序進行演算而過濾惡劣環境中的雜訊，以避免惡劣環境影響光學雷達的感測準確度。

100:光達系統

10:處理模組

11:鄰近點雲過濾單元

12:卡爾曼過濾單元

20:光學雷達

30:行車電腦

40:定位模組

50:電源供應器

X:X軸

Y:Y軸

Z:Z軸

S:環境框架

P:點雲

C:取樣圓

R:取樣半徑

D:圓心距離

[圖1]係為本發明之光達系統架構示意圖。

[圖2]係為本發明所取得之點雲模型資料之立體示意圖。

[圖3]係為本發明所取得之點雲模型資料之上視圖，並顯示取樣狀態。

[圖4]係為本發明之點雲模型資料經由第一次演算過濾後的過濾模型資料之立體示意圖。

[圖5]係為本發明之點雲模型資料經由第二次演算過濾後的低雜訊環境模型資料之立體示意圖。

以下參照各附圖詳細描述本發明的示例性實施例，且不意圖將本發明的技術原理限制於特定公開的實施例，而本發明的範圍僅由申請專利範圍限制，涵蓋了替代、修改和等同物。

請參閱圖1至圖5所示，係為本發明一種能夠降低環境雜訊的光達系統100，其應用於車輛上，所述的車輛包括但不限於房車、卡車、貨車、跑車等，光達系統100包括一處理模組10、一光學雷達20、一行車電腦30、一定位模組40及一電源供應器50。光學雷達20、行車電腦30、定位模組40及電源供應器50分別電性連接於處理模組10，而在其他實施例中，行車電腦30非為光達系統100之構件，使光達系統100電性連接於車輛之行車電腦30亦可。於本發明實施例中，定位模組40為全球衛星定位系統(GPS)，用以接收衛星定位訊號，並提供處理模組10進行車輛的定位；電源供應器50為9v、1A或18v、2A的變壓器，用以電性連接於車輛的電池或電瓶。光學雷達20選自於Velodyne LiDAR雷達公司之16層360度的三維光達感測器(型號為VLP-16)，其每秒有30萬個點、360度水平視場角以及30度的垂直視場角，且最遠有效感測範圍為100公尺，最近有效範圍為30公分。

光學雷達20係自偵測環境中取得一點雲模型資料。所述的點雲模型資料包括一具有X軸、Y軸、Z軸的環境框架S及位於環境框架S內、外側的複數點雲P(Point Cloud)，因此所述的點雲P至少具有幾何位置資訊以外，還有可能含有色彩資訊或目標物反射面強度資訊。其中，在判斷是否列為雜訊時，在超過環境框架S外側一定距離的點雲P忽略不計。

處理模組10包含有一鄰近點雲過濾單元11以及一卡爾曼過濾單元12，鄰近點雲過濾單元11接收點雲模型資料並進行處理，以便輸出一個過濾模型資料，卡爾曼過濾單元12接收過濾模型資料，以便過濾輸出一個低雜訊環境模型資料，藉此，當車輛行駛於如下雨、下雪、起霧的惡劣環境當中，透過處理模組10的兩次過濾處理，而能降低環境雜訊對於光學雷達20的感測和性能影響，進而改善光學雷達20的判斷。

以下進一步說明本發明的降低環境雜訊的處理方法：鄰近點雲過濾單元11於環境框架S內、外側的範圍以複數個取樣圓C進行點雲P的取樣，請配合參閱圖3所示，取樣圓C具有一個取樣半徑R，於本發明實施例中，取樣半徑R為2公分，且兩個相鄰的取樣圓C之圓心距離D介於1公分至3公分之間，以使兩個相鄰的取樣圓C局部交疊，如此能夠避免在取樣時，於兩個取樣圓C之間產生空隙，而導致空隙中的點雲P不被列入取樣資訊中，使得取樣資訊不夠精準的問題。

當每一個取樣圓C範圍內所取得點雲P數量大於一個臨界判斷數值時，則保留取樣圓C，反之，取樣圓C範圍內所取得點雲P數量少於臨界判斷數值時，點雲P則當作雜訊被濾除。於本發明實施例中，臨界判斷數值為10個。因此，當某一取樣圓C所取得的點雲P的數量少於10個時，此一取樣圓C範圍內的點雲P會被當作雜訊過濾掉，如此一來，對於環境中的微小雜訊，可忽略不計，如圖4所示。例如是車輛行駛中遇到毛毛雨時，而能透過前述方式過濾掉雨滴所帶來的雜訊，以便車輛不會因為雨滴產生誤判為物體而停止下來。然而，鄰近點雲過濾單元11可以過濾大部分的環境雜訊，但在車輛遇到濃霧情形時，光學雷達20仍無法建立起準確的空間模型資料。

因此接著，本發明以卡爾曼過濾單元12接收過濾模型資料，過濾輸出低雜訊環境模型資料。於本發明實施例中，卡爾曼過濾單元12為一種卡爾曼濾波器(Kalman Filter)，其具有實時性、快速性、高效性及抗干擾性等優點。其中，卡爾曼過濾單元12進行處理時都包含兩個步驟，主要先計算一個預估值，在對預估值和測量值做加權求和，以便得到最佳結果狀態。更進一步的說明，卡爾曼過濾單元12主要會進行五個程序：(1)利用k-1時刻的最佳結果狀態

去計算在k時刻的預估值

；(2)利用k-1時刻最佳結果狀態

的雜訊P_k-1去計算在k時刻預估值

的雜訊

；(3)利用k時刻預估值

的雜訊

和k時刻測量值z_k得雜訊r去計算k時刻的卡爾曼增益k_k；(4)利用k時刻的預估值

、k時刻的測量值z_k和k時刻的卡爾曼增益k_k去計算k時刻的最佳結果狀態

；(5)利用k時刻預估值

的雜訊

和k時刻的卡爾曼增益k_k去計算k時刻最佳結果狀態

的誤差P_k。

因此透過卡爾曼過濾單元12處理而改善空間模型資料，據以過濾輸出低雜訊環境模型資料，從而降低環境雜訊對於光學雷達20感測的干擾，特別是卡爾曼過濾單元12可以用來過濾掉濃霧所帶來的雜訊，如圖5所示。

據此，本發明以鄰近點雲過濾單元11與卡爾曼過濾單元12進行兩次過濾處理，以便過濾修正光學雷達20所感測取得之點雲模型資料，使點雲模型資料於演算過濾前與演算過濾後的誤差值能夠明顯的下降10%~30%左右，讓本發明光達系統100在惡劣天氣與環境中改善感測訊號，降低環境雜訊對於光學電達20的不利影響。

因此，本發明能夠運用於自駕車上，降低自駕車使用其他輔助設備才能夠在惡劣環境中提升感測的準確度，故本發明節省了其他偵測設備的安裝，降低自駕車的成本。

雖然本發明是以一個最佳實施例作說明，精於此技藝者能在不脫離本發明精神與範疇下作各種不同形式的改變。以上所舉實施例僅用以說明本發明而已，非用以限制本發明之範圍。舉凡不違本發明精神所從事的種種修改或改變，俱屬本發明申請專利範圍。