TW202235910A - Lidar system capable of reducing environmental noise - Google Patents
Lidar system capable of reducing environmental noise Download PDFInfo
- Publication number
- TW202235910A TW202235910A TW110108889A TW110108889A TW202235910A TW 202235910 A TW202235910 A TW 202235910A TW 110108889 A TW110108889 A TW 110108889A TW 110108889 A TW110108889 A TW 110108889A TW 202235910 A TW202235910 A TW 202235910A
- Authority
- TW
- Taiwan
- Prior art keywords
- point cloud
- model data
- lidar system
- environmental noise
- sampling
- Prior art date
Links
Images
Landscapes
- Optical Radar Systems And Details Thereof (AREA)
Abstract
Description
本發明係有關於一種能夠降低環境雜訊的光達系統,其透過兩次演算法而過濾雜訊,以降低光達系統在惡劣環境中的環境雜訊。The present invention relates to a LiDAR system capable of reducing environmental noise. The noise is filtered through two algorithms to reduce the environmental noise of the LiDAR system in a harsh environment.
按,先進駕駛輔助系統(Advanced Driver Assistance Systems;ADAS),是近年來車廠積極發展的車輛技術之一,而ADAS的主要功能是為駕駛人提供車輛的行進情形與車外環境變化等相關資訊進行分析,且預先警告可能發生的危險狀況,讓駕駛人提早採取因應措施,避免交通意外發生。Press, Advanced Driver Assistance Systems (Advanced Driver Assistance Systems; ADAS) is one of the vehicle technologies actively developed by car manufacturers in recent years, and the main function of ADAS is to provide drivers with relevant information such as the driving situation of the vehicle and changes in the external environment for analysis , and pre-warning of possible dangerous situations, allowing drivers to take countermeasures in advance to avoid traffic accidents.
然而,隨著ADAS的快速發展,越來越多的車廠也開始致力於發展自駕車,故自駕車勢嚴然為汽車產業的未來趨勢。However, with the rapid development of ADAS, more and more car manufacturers are also beginning to devote themselves to the development of self-driving cars, so self-driving cars are definitely the future trend of the automotive industry.
而光學雷達在自駕車上是不可或缺的重要元件之一,透過光學雷達能夠感測車輛外的環境狀況,惟光學雷達也是有使用上的限制,例如光學雷達會受到很多因素的影響,主要的影響有:光學雷達發射接收的雜訊、車輛移動造成的雜訊、環境雜訊等。Optical radar is one of the indispensable and important components in self-driving cars. Through optical radar, it can sense the environmental conditions outside the vehicle. However, optical radar also has limitations in use. For example, optical radar is affected by many factors, mainly The impacts include: optical radar transmission and reception noise, noise caused by vehicle movement, environmental noise, etc.
其中,環境雜訊包括從星體、地球、太陽、大氣、雲或者任何不應該有的輻射源照射到或反射到接收端上的訊號,此外惡劣天氣也是環境雜訊的一種,如大雨、下雪、濃霧等皆會使光學雷達回波的偵測能力大幅下降,致使光學電達因環境雜訊而產生誤判,舉例來說,在大雨或濃霧中,水滴可能被誤判為車輛前方的物體,使得車輛停止下來,因此如何改善光學雷達所面對的雜訊問題,係為本發明所欲解決課題之一。Among them, environmental noise includes signals from stars, the earth, the sun, the atmosphere, clouds, or any radiation sources that should not be irradiated or reflected to the receiving end. In addition, severe weather is also a type of environmental noise, such as heavy rain and snow. , dense fog, etc. will greatly reduce the detection ability of the optical radar echo, resulting in misjudgment of the optical radar due to environmental noise. For example, in heavy rain or dense fog, water droplets may be misjudged as objects in front of the vehicle, making the The vehicle stops, so how to improve the noise problem faced by the optical radar is one of the problems to be solved by the present invention.
為解決上述課題,本發明揭露一種能夠降低環境雜訊的光達系統,其利用兩次演算過濾惡劣環境中的雜訊,以避免惡劣環境影響光學雷達的感測準確度。In order to solve the above problems, the present invention discloses a lidar system capable of reducing environmental noise, which uses two calculations to filter the noise in harsh environments, so as to prevent the harsh environment from affecting the sensing accuracy of the optical radar.
為達上述目的,本發明一項實施例中提供一種能夠降低環境雜訊的光達系統,其包括一光學雷達及一處理模組。光學雷達自偵測環境中取得一點雲模型資料;以及處理模組係電性連接於光學雷達,處理模組包含有一鄰近點雲過濾單元以及一卡爾曼過濾單元,鄰近點雲過濾單元接收點雲模型資料並進行處理,以便輸出一個過濾模型資料,卡爾曼過濾單元接收過濾模型資料,以便過濾輸出一個低雜訊環境模型資料。To achieve the above purpose, an embodiment of the present invention provides a lidar system capable of reducing environmental noise, which includes an optical radar and a processing module. The optical radar obtains point cloud model data from the detection environment; and the processing module is electrically connected to the optical radar. The processing module includes a neighboring point cloud filtering unit and a Kalman filtering unit, and the neighboring point cloud filtering unit receives the point cloud The model data is processed to output a filtered model data, and the Kalman filter unit receives the filtered model data to filter and output a low-noise environment model data.
於本發明另一實施例中,點雲模型資料包括一具有X軸、Y軸、Z軸的環境框架及位於環境框架內、外側的複數點雲,其中,超過環境框架外側一定距離的點雲忽略不計。In another embodiment of the present invention, the point cloud model data includes an environment frame with an X axis, a Y axis, and a Z axis, and complex point clouds located inside and outside the environment frame, wherein the point cloud exceeding a certain distance outside the environment frame can be ignored.
於本發明另一實施例中,鄰近點雲過濾單元於環境框架內、外側的範圍以複數個取樣圓進行點雲的取樣,且兩個相鄰的取樣圓局部交疊,當取樣圓範圍內所取得點雲數量大於一個臨界判斷數值時,則保留取樣圓。In another embodiment of the present invention, the adjacent point cloud filtering unit samples the point cloud with a plurality of sampling circles within and outside the environment frame, and two adjacent sampling circles partially overlap, when within the scope of the sampling circle When the number of obtained point clouds is greater than a critical judgment value, the sampling circle is retained.
於本發明另一實施例中,取樣圓具有一個取樣半徑,取樣半徑為2公分。In another embodiment of the present invention, the sampling circle has a sampling radius, and the sampling radius is 2 cm.
於本發明另一實施例中,兩個相鄰的取樣圓之圓心距離介於1公分至3公分之間。In another embodiment of the present invention, the distance between the centers of two adjacent sampling circles is between 1 cm and 3 cm.
於本發明另一實施例中,臨界判斷數值為10個,當取樣圓範圍內的點雲數量少於臨界判斷數值時,點雲則當作雜訊被濾除。In another embodiment of the present invention, the critical judgment value is 10, and when the number of point clouds within the sampling circle is less than the critical judgment value, the point cloud is regarded as noise and is filtered out.
於本發明另一實施例中,更包括一行車電腦、一定位模組及一電源供應器,係分別電性連接於處理模組。In another embodiment of the present invention, it further includes an on-board computer, a positioning module and a power supply, which are respectively electrically connected to the processing module.
藉此,本發明利用鄰近點雲過濾單元以及卡爾曼過濾單元依序進行演算而過濾惡劣環境中的雜訊,以避免惡劣環境影響光學雷達的感測準確度。In this way, the present invention utilizes the adjacent point cloud filter unit and the Kalman filter unit to sequentially perform calculations to filter noise in harsh environments, so as to prevent the harsh environment from affecting the sensing accuracy of the optical radar.
以下參照各附圖詳細描述本發明的示例性實施例,且不意圖將本發明的技術原理限制於特定公開的實施例,而本發明的範圍僅由申請專利範圍限制,涵蓋了替代、修改和等同物。Exemplary embodiments of the present invention are described in detail below with reference to the accompanying drawings, and it is not intended to limit the technical principles of the present invention to specific disclosed embodiments, but the scope of the present invention is only limited by the scope of the patent application, covering substitutions, modifications and equivalent.
請參閱圖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公分。Please refer to FIG. 1 to FIG. 5, which is a
光學雷達20係自偵測環境中取得一點雲模型資料。所述的點雲模型資料包括一具有X軸、Y軸、Z軸的環境框架S及位於環境框架S內、外側的複數點雲P(Point Cloud),因此所述的點雲P至少具有幾何位置資訊以外,還有可能含有色彩資訊或目標物反射面強度資訊。其中,在判斷是否列為雜訊時,在超過環境框架S外側一定距離的點雲P忽略不計。The
處理模組10包含有一鄰近點雲過濾單元11以及一卡爾曼過濾單元12,鄰近點雲過濾單元11接收點雲模型資料並進行處理,以便輸出一個過濾模型資料,卡爾曼過濾單元12接收過濾模型資料,以便過濾輸出一個低雜訊環境模型資料,藉此,當車輛行駛於如下雨、下雪、起霧的惡劣環境當中,透過處理模組10的兩次過濾處理,而能降低環境雜訊對於光學雷達20的感測和性能影響,進而改善光學雷達20的判斷。The
以下進一步說明本發明的降低環境雜訊的處理方法:The processing method for reducing environmental noise of the present invention is further described below:
鄰近點雲過濾單元11於環境框架S內、外側的範圍以複數個取樣圓C進行點雲P的取樣,請配合參閱圖3所示,取樣圓C具有一個取樣半徑R,於本發明實施例中,取樣半徑R為2公分,且兩個相鄰的取樣圓C之圓心距離D介於1公分至3公分之間,以使兩個相鄰的取樣圓C局部交疊,如此能夠避免在取樣時,於兩個取樣圓C之間產生空隙,而導致空隙中的點雲P不被列入取樣資訊中,使得取樣資訊不夠精準的問題。The adjacent point
當每一個取樣圓C範圍內所取得點雲P數量大於一個臨界判斷數值時,則保留取樣圓C,反之,取樣圓C範圍內所取得點雲P數量少於臨界判斷數值時,點雲P則當作雜訊被濾除。於本發明實施例中,臨界判斷數值為10個。因此,當某一取樣圓C所取得的點雲P的數量少於10個時,此一取樣圓C範圍內的點雲P會被當作雜訊過濾掉,如此一來,對於環境中的微小雜訊,可忽略不計,如圖4所示。例如是車輛行駛中遇到毛毛雨時,而能透過前述方式過濾掉雨滴所帶來的雜訊,以便車輛不會因為雨滴產生誤判為物體而停止下來。然而,鄰近點雲過濾單元11可以過濾大部分的環境雜訊,但在車輛遇到濃霧情形時,光學雷達20仍無法建立起準確的空間模型資料。When the number of point clouds P obtained within the scope of each sampling circle C is greater than a critical judgment value, the sampling circle C is retained; otherwise, when the number of point clouds P obtained within the scope of the sampling circle C is less than the critical judgment value, the point cloud P is filtered out as noise. In the embodiment of the present invention, the critical judgment value is 10. Therefore, when the number of point clouds P obtained by a certain sampling circle C is less than 10, the point clouds P within the range of this sampling circle C will be filtered out as noise. Minor noise can be ignored, as shown in Figure 4. For example, when the vehicle encounters drizzle while driving, the noise caused by the raindrops can be filtered out through the aforementioned method, so that the vehicle will not stop due to the misjudgment of the raindrops as objects. However, the neighboring point
因此接著,本發明以卡爾曼過濾單元12接收過濾模型資料,過濾輸出低雜訊環境模型資料。於本發明實施例中,卡爾曼過濾單元12為一種卡爾曼濾波器(Kalman Filter),其具有實時性、快速性、高效性及抗干擾性等優點。其中,卡爾曼過濾單元12進行處理時都包含兩個步驟,主要先計算一個預估值,在對預估值和測量值做加權求和,以便得到最佳結果狀態。更進一步的說明,卡爾曼過濾單元12主要會進行五個程序:
(1)利用
時刻的最佳結果狀態
去計算在k時刻的預估值
;
(2)利用
時刻最佳結果狀態的雜訊
去計算在k時刻預估值的雜訊
;
(3)利用k時刻預估值的雜訊
和k時刻測量值得雜訊r去計算k時刻的卡爾曼增益
;
(4)利用k時刻的預估值
、k時刻的測量值
和k時刻的卡爾曼增益
去計算k時刻的最佳結果狀態
;
(5)利用k時刻預估值的雜訊
和k時刻的卡爾曼增益
去計算k時刻最佳結果狀態
的誤差
。
Therefore, in the present invention, the Kalman
因此透過卡爾曼過濾單元12處理而改善空間模型資料,據以過濾輸出低雜訊環境模型資料,從而降低環境雜訊對於光學雷達20感測的干擾,特別是卡爾曼過濾單元12可以用來過濾掉濃霧所帶來的雜訊,如圖5所示。Therefore, the space model data is improved through the Kalman
據此,本發明以鄰近點雲過濾單元11與卡爾曼過濾單元12進行兩次過濾處理,以便過濾修正光學雷達20所感測取得之點雲模型資料,使點雲模型資料於演算過濾前與演算過濾後的誤差值能夠明顯的下降10%~30%左右,讓本發明光達系統100在惡劣天氣與環境中改善感測訊號,降低環境雜訊對於光學電達20的不利影響。Accordingly, the present invention performs two filtering processes with the adjacent point
因此,本發明能夠運用於自駕車上,降低自駕車使用其他輔助設備才能夠在惡劣環境中提升感測的準確度,故本發明節省了其他偵測設備的安裝,降低自駕車的成本。Therefore, the present invention can be applied to self-driving cars, reducing the use of other auxiliary equipment for self-driving cars to improve the accuracy of sensing in harsh environments, so the present invention saves the installation of other detection equipment and reduces the cost of self-driving cars.
雖然本發明是以一個最佳實施例作說明,精於此技藝者能在不脫離本發明精神與範疇下作各種不同形式的改變。以上所舉實施例僅用以說明本發明而已,非用以限制本發明之範圍。舉凡不違本發明精神所從事的種種修改或改變,俱屬本發明申請專利範圍。Although the present invention has been described in terms of a preferred embodiment, those skilled in the art can make various changes without departing from the spirit and scope of the present invention. The above-mentioned embodiments are only used to illustrate the present invention, and are not intended to limit the scope of the present invention. All modifications or changes that do not violate the spirit of the present invention belong to the patent scope of the present invention.
100:光達系統 10:處理模組 11:鄰近點雲過濾單元 12:卡爾曼過濾單元 20:光學雷達 30:行車電腦 40:定位模組 50:電源供應器 X:X軸 Y:Y軸 Z:Z軸 S:環境框架 P:點雲 C:取樣圓 R:取樣半徑 D:圓心距離 100:Lidar system 10: Processing module 11: Neighboring point cloud filtering unit 12: Kalman filter unit 20: Optical Radar 30: Trip computer 40:Positioning module 50: Power supply X:X axis Y: Y-axis Z: Z-axis S: Environmental framework P: point cloud C: Sampling circle R: sampling radius D: Center distance
[圖1]係為本發明之光達系統架構示意圖。 [圖2]係為本發明所取得之點雲模型資料之立體示意圖。 [圖3]係為本發明所取得之點雲模型資料之上視圖,並顯示取樣狀態。 [圖4]係為本發明之點雲模型資料經由第一次演算過濾後的過濾模型資料之立體示意圖。 [圖5]係為本發明之點雲模型資料經由第二次演算過濾後的低雜訊環境模型資料之立體示意圖。 [Fig. 1] is a schematic diagram of the structure of the LiDAR system of the present invention. [Fig. 2] is a three-dimensional schematic diagram of the point cloud model data obtained by the present invention. [Fig. 3] is the top view of the point cloud model data obtained by the present invention, and shows the sampling status. [Fig. 4] is a three-dimensional schematic diagram of the filtered model data after the point cloud model data of the present invention is filtered through the first calculation. [Fig. 5] is a three-dimensional schematic diagram of the low-noise environment model data after the point cloud model data of the present invention is filtered through the second calculation.
100:光達系統 100:Lidar system
10:處理模組 10: Processing module
11:鄰近點雲過濾單元 11: Adjacent point cloud filter unit
12:卡爾曼過濾單元 12: Kalman filter unit
20:光學雷達 20: Optical radar
30:行車電腦 30: Trip computer
40:定位模組 40: Positioning module
50:電源供應器 50: Power supply
Claims (7)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW110108889A TWI759137B (en) | 2021-03-12 | 2021-03-12 | Lidar system capable of reducing environmental noise |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW110108889A TWI759137B (en) | 2021-03-12 | 2021-03-12 | Lidar system capable of reducing environmental noise |
Publications (2)
Publication Number | Publication Date |
---|---|
TWI759137B TWI759137B (en) | 2022-03-21 |
TW202235910A true TW202235910A (en) | 2022-09-16 |
Family
ID=81710888
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW110108889A TWI759137B (en) | 2021-03-12 | 2021-03-12 | Lidar system capable of reducing environmental noise |
Country Status (1)
Country | Link |
---|---|
TW (1) | TWI759137B (en) |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106772435B (en) * | 2016-12-12 | 2019-11-19 | 浙江华飞智能科技有限公司 | A kind of unmanned plane barrier-avoiding method and device |
CN110501719B (en) * | 2019-08-27 | 2024-02-09 | 湖南九域同创高分子新材料有限责任公司 | Laser radar-based train obstacle detection method |
-
2021
- 2021-03-12 TW TW110108889A patent/TWI759137B/en active
Also Published As
Publication number | Publication date |
---|---|
TWI759137B (en) | 2022-03-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11125881B2 (en) | Lidar-based trailer tracking | |
CN109215083B (en) | Method and device for calibrating external parameters of vehicle-mounted sensor | |
US20210291902A1 (en) | Method and apparatus for trailer angle measurement and vehicle | |
US11671564B2 (en) | Adjusting vehicle sensor field of view volume | |
US20220035036A1 (en) | Method and apparatus for positioning movable device, and movable device | |
CN106909152A (en) | A kind of automobile-used context aware systems and automobile | |
CN112083441B (en) | Obstacle detection method and system for depth fusion of laser radar and millimeter wave radar | |
KR20210048548A (en) | How to detect an angle measurement error in a radar sensor | |
CN107274721B (en) | Multi-vehicle cooperative positioning method in intelligent transportation system | |
CN103221840B (en) | Location determining device in motor vehicles and information fusion method | |
CN115144825A (en) | External parameter calibration method and device for vehicle-mounted radar | |
CN112904317A (en) | Calibration method for multi-laser radar and GNSS-INS system | |
CN102923000B (en) | A kind of automobile based on binocular vision target detect is initiatively moveed backward speed-limiting control method | |
CN110379178A (en) | Pilotless automobile intelligent parking method based on millimetre-wave radar imaging | |
CN112485784B (en) | Method and device for determining risk coefficient of target in inner wheel difference area, electronic equipment and storage medium | |
WO2023005572A1 (en) | Application method for technique for filtering vehicle body from point cloud data of autonomous driving mining truck | |
CN114910109A (en) | Method for calibrating at least one sensor by using at least one calibration sensor | |
TWI759137B (en) | Lidar system capable of reducing environmental noise | |
CN114407780A (en) | Anti-collision early warning method for differential area of inner wheels of semitrailer based on double gyroscopes | |
CN111141252B (en) | Monocular calibration ranging method and system | |
CN113702967A (en) | Vehicle target guiding and tracking method of ground unmanned platform and vehicle-mounted system | |
CN110542902A (en) | Simple height measurement method suitable for vehicle-mounted millimeter wave radar | |
CN113191303B (en) | Method for calculating distance and steering of front vehicle based on single camera | |
CN210070960U (en) | Vehicle with a steering wheel | |
CN111932883B (en) | Method for guiding unmanned driving by utilizing broadcast communication of road side equipment |