TWI559267B - Method of quantifying the reliability of obstacle classification - Google Patents

Method of quantifying the reliability of obstacle classification Download PDF

Info

Publication number
TWI559267B
TWI559267B TW104140639A TW104140639A TWI559267B TW I559267 B TWI559267 B TW I559267B TW 104140639 A TW104140639 A TW 104140639A TW 104140639 A TW104140639 A TW 104140639A TW I559267 B TWI559267 B TW I559267B
Authority
TW
Taiwan
Prior art keywords
obstacle
classification
confidence
probability
obstacles
Prior art date
Application number
TW104140639A
Other languages
Chinese (zh)
Other versions
TW201721608A (en
Inventor
bing-min Xu
ming-hong Li
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed filed Critical
Priority to TW104140639A priority Critical patent/TWI559267B/en
Application granted granted Critical
Publication of TWI559267B publication Critical patent/TWI559267B/en
Publication of TW201721608A publication Critical patent/TW201721608A/en

Links

Landscapes

  • Traffic Control Systems (AREA)

Description

障礙物分類可靠度量化之方法Method for reliable measurement of obstacle classification

本發明係有關一種物體分類可靠度之量化方法,特別是指一種應用於感知融合系統之障礙物分類可靠度量化之方法。 The invention relates to a method for quantifying the reliability of object classification, in particular to a method for reliably classifying obstacle classifications applied to a perceptual fusion system.

目前車用電腦的功能愈趨健全,為了提升駕駛安全性、朝向自動駕駛的未來,車前障礙物偵測及分類之可靠度便顯得尤為重要,其係將偵測到之車前障礙物分類為汽車、行人、腳踏車、電線桿等各種不同物體,依據系統設定決定分類項目,如此一來,系統便可依據障礙物的分類決定是提示剎車、自動緊急剎車或執行其他動作。 At present, the functions of the vehicle computer are becoming more and more perfect. In order to improve the safety of driving and the future of autonomous driving, the reliability of the detection and classification of the obstacles in front of the vehicle is particularly important. For various objects such as cars, pedestrians, bicycles, and utility poles, the classification items are determined according to the system settings. In this way, the system can determine whether to prompt the brakes, automatically brake, or perform other actions according to the classification of the obstacles.

第1圖為習知技術中偵測車前障礙物及感知融合之方塊圖,攝影機10擷取前方道路影像,複數感測器11、12可偵測前方障礙物之距離、或是擷取車輛本身的車身訊號,且多個感測器11、12所偵測到之障礙物距離又可得到障礙物高度、輪廓等資訊,接著,一方面依據前方道路影像、障礙物資訊及車身訊號,會各自解析障礙物資訊13,並計算障礙物之位置、分類融合資訊15,另一方面則依據前方道路影像、障礙物資訊及車身訊號,各自估算偵測信心度14,亦即前方障礙物存在的準確度,並進行偵測信心度融合16,最後輸出資訊17,此輸出資訊17可包括障礙物確實存在之機率及座標位置,及障礙物可能的類別。但系統計算出之偵測信心度是否正確,並沒有一個機制可進行再次確認,便直接相信偵測信心度的融合結果。 FIG. 1 is a block diagram of detecting front obstacles and perceptual fusion in the prior art, the camera 10 captures the road image in front, and the plurality of sensors 11 and 12 can detect the distance of the obstacle in front or capture the vehicle. The body signal of the vehicle itself, and the obstacle distance detected by the plurality of sensors 11, 12 can obtain the obstacle height, the contour and the like, and then, based on the road image, the obstacle information and the body signal, on the one hand, Each of the obstacle information 13 is analyzed, and the position of the obstacle is calculated, and the classification information 15 is calculated. On the other hand, the detection confidence level 14 is estimated based on the road image, the obstacle information and the body signal, which are the front obstacles. Accuracy, and the detection of confidence fusion 16 , and finally output information 17, this output information 17 may include the probability of the obstacle does exist and the coordinate position, and the possible categories of obstacles. However, the system calculates whether the confidence of detection is correct, and there is no mechanism to reconfirm, and directly believes in the fusion result of detecting confidence.

逕行信任偵測信心度,若發生誤判時會造成嚴重的後果,以真實案例如第2圖所示,車輛18a上的車用電腦具有偵測前方障礙物及分類警示的系 統,其與前車18b保持安全距離,而右側車道行駛有一台大型油罐車18c,當油罐車18c從車輛18a旁邊經過時,前車18b反射回來的毫米波在旁邊經過的油罐車18c上發生了漫射,車輛18a的系統接收到漫射的毫米波後做出了「與前方車輛發生碰撞的可能性很高」的判斷,隨即做出自動緊急剎車,後車18d反應不及而發生追尾。但實際上,前方近處並沒有車輛在行駛,只是油罐車18c行駛在相鄰的右側車道而已,系統誤判雜訊為車輛,導致誤剎車。 Passing trust to detect confidence, if there is a misjudgment, it will have serious consequences. In the real case, as shown in Figure 2, the vehicle computer on vehicle 18a has a system for detecting obstacles in front and classifying warnings. The system maintains a safe distance from the preceding vehicle 18b, while the right lane drives a large tanker 18c. When the tanker 18c passes by the vehicle 18a, the millimeter wave reflected by the preceding vehicle 18b passes by the tanker. Diffuse occurred on the 18c, and the system of the vehicle 18a received a diffuse millimeter wave and made a judgment that "the possibility of collision with the preceding vehicle is high", and then an automatic emergency brake was made, and the rear vehicle 18d did not respond. A rear-end collision occurred. However, in fact, there is no vehicle in the vicinity of the front, but the tanker 18c is driving in the adjacent right lane. The system misjudges the noise as a vehicle, causing a false brake.

因此,如何讓偵測信心度及分類信心度具有更高的準確性,並將融合資訊量化提供更高的參考性,避免再發生誤判之情事為當前一項重要的課題。本發明即提出一種障礙物分類可靠度量化之方法,具體架構及其實施方式將詳述於下: Therefore, how to make the detection confidence and classification confidence have higher accuracy, and to provide more reference for the fusion of information to avoid further misjudgment is an important issue at present. The invention proposes a method for reliably classifying obstacle classification, and the specific architecture and its implementation manner will be described in detail below:

本發明之主要目的在提供一種障礙物分類可靠度量化之方法,其係將障礙物分類資訊的可靠度進行量化,提升分類準確性,避免後端主動安全系統因採計錯誤資訊而使安全機制誤動作,形成系統失效。 The main object of the present invention is to provide a method for reliably classifying obstacle classification, which quantifies the reliability of obstacle classification information, improves classification accuracy, and avoids the security mechanism of the back-end active safety system due to mistaking information. Malfunction, system failure.

本發明之另一目的在提供一種障礙物分類可靠度量化之方法,其係將測距感測器、影像擷取單元及車身訊號感測器所擷取之資訊加以融合,得到所有感測器針對每個障礙物的一位置資訊、一分類資訊及一分類信心度資訊。 Another object of the present invention is to provide a method for reliably classifying obstacle classification, which combines information captured by a distance measuring sensor, an image capturing unit, and a body signal sensor to obtain all sensors. A location information, a classification information, and a classification confidence information for each obstacle.

本發明之再一目的在提供一種障礙物分類可靠度量化之方法,更包括一分類失效過濾機制,若量化之障礙物分類可靠度小於一預設值時代表分類錯誤,則略過此障礙物,反之,若障礙物分類可靠度大於等於預設值時,系統會通知駕駛者,若是自動駕駛系統則可自動剎車。 A further object of the present invention is to provide a method for reliably classifying obstacle classification, and further comprising a classification failure filtering mechanism. If the quantitative obstacle classification reliability is less than a preset value, it represents a classification error, and the obstacle is skipped. On the contrary, if the reliability of the obstacle classification is greater than or equal to the preset value, the system will notify the driver, and if it is an automatic driving system, it can automatically brake.

為達上述之目的,本發明提供一種障礙物分類可靠度量化之方法,其應用於車輛之一車用電腦中之一感知融合系統,該車用電腦連接一影像擷取單元、一車身訊號感測器及複數測距感測器,此方法包括下列步驟:車用 電腦接收至少一障礙物之障礙物資訊、對應障礙物資訊之至少一影像資訊及複數車身訊號,並利用一分類器對障礙物資訊、影像資訊及車身訊號進行類別分類;感知融合系統對測距感測器之偵測結果分別計算一偵測信心度;讀取分類器之準確度,利用偵測信心度及準確度計算每一測距感測器對應每一障礙物之一分類信心度;對所有分類信心度進行融合計算,分別量化所有測距感測器對每一障礙物之障礙物分類可靠度;擷取任一障礙物分類可靠度後,依據障礙物分類可靠度進行一分類失效過濾機制,排除障礙物分類可靠度小於一預設值之障礙物。 In order to achieve the above object, the present invention provides a method for reliably classifying obstacles, which is applied to a sensory fusion system in a vehicle computer, which is connected to an image capturing unit and a body signal. Detector and complex ranging sensor, the method comprises the following steps: vehicle The computer receives at least one obstacle obstacle information, at least one image information corresponding to the obstacle information, and a plurality of body signals, and uses a classifier to classify the obstacle information, the image information, and the body signal; the sensing fusion system measures the distance The detection result of the sensor respectively calculates a detection confidence; reads the accuracy of the classifier, and uses the detection confidence and accuracy to calculate the classification confidence of each obstacle corresponding to each obstacle sensor; Convergence calculation is carried out for all classification confidences, and the reliability of obstacle classification for each obstacle is quantified by each ranging sensor; after any obstacle classification reliability is obtained, a classification failure is performed according to the obstacle classification reliability. The filtering mechanism eliminates obstacles whose obstacle classification reliability is less than a preset value.

其中,偵測信心度為測距感測器所偵測之障礙物為實體物的機率。偵測信心度係利用測距感測器分別針對當下偵測的障礙物進行座標追蹤,再將後續接收到之一實際值與追蹤值比對,以定義出所追蹤的障礙物於當下實際存在之機率。此障礙物之追蹤、比對及定義出偵測信心度係利用一共同綜合概率數據關聯(Joint Integrated Probabilistic Data Association,JIPDA)計算。 The detection confidence is the probability that the obstacle detected by the ranging sensor is a physical object. The detection confidence system uses the ranging sensor to perform coordinate tracking on the obstacles currently detected, and then compares one of the actual values received with the tracking values to define the obstacles that are actually present in the current situation. Probability. Tracking, comparing, and defining the confidence of the obstacle is calculated using a Joint Integrated Probabilistic Data Association (JIPDA).

本發明中,融合計算係利用分類信心度、測距感測器之準確度及至少一障礙物連續偵測機率計算出障礙物分類可靠度,其中,障礙物連續偵測機率為測距感測器連續偵測到同一障礙物之機率。 In the present invention, the fusion computing system calculates the reliability of the obstacle classification by using the classification confidence, the accuracy of the ranging sensor, and the probability of continuous detection of at least one obstacle, wherein the continuous detection probability of the obstacle is ranging sensing. The probability of the same obstacle being continuously detected.

承上,若沒有影像可供判斷障礙物分類時,例如僅有雷達的偵測資訊時,障礙物連續偵測機率之判斷方式包含下列步驟:假設欲判斷障礙物是否為車,首先接收測距感測器所偵測之障礙物資訊;比對和前一筆障礙物資訊中之障礙物是否為同一個,若否,則判別障礙物不是車,若是,再判斷連續偵測到同一障礙物是否超過一預設次數;以及若連續偵測到同一障礙物超過預設次數,則判斷障礙物是車,若否,則判別障礙物不是車。 According to the above, if there is no image to judge the obstacle classification, for example, only the radar detection information, the method for judging the obstacle continuous detection probability includes the following steps: suppose that it is determined whether the obstacle is a car, first receiving the distance measurement The information of the obstacle detected by the sensor; whether the obstacle in the information of the previous obstacle is the same, if not, the obstacle is not the car, and if so, whether the same obstacle is continuously detected If the same obstacle is detected continuously for more than a preset number of times, it is determined that the obstacle is a vehicle, and if not, the obstacle is determined not to be a vehicle.

當計算出之障礙物分類可靠度大於等於預設值時,車用電腦會以聽覺、觸覺或視覺方式告知車輛之駕駛者前方障礙物資訊,且車用電腦更告知 駕駛者障礙物為車子或行人之機率。同時,感知融合系統會回到上一步驟,擷取另一障礙物分類可靠度,繼續判斷其是否小於預設值。 When the calculated obstacle classification reliability is greater than or equal to the preset value, the vehicle computer will inform the driver of the obstacle information in front of the vehicle in an audible, tactile or visual manner, and the vehicle computer informs The driver's obstacle is the probability of a car or a pedestrian. At the same time, the perceptual fusion system will return to the previous step, take another obstacle classification reliability, and continue to judge whether it is less than the preset value.

本發明步驟中之分類失效過濾機制係包括下列步驟:擷取任一障礙物之障礙物分類可靠度;判斷所擷取之障礙物分類可靠度是否小於預設值,若是,則將障礙物視為分類誤判並過濾,反之,則擷取另一障礙物之障礙物分類可靠度再次進行判斷。 The classification failure filtering mechanism in the steps of the present invention includes the following steps: capturing the reliability of the obstacle classification of any obstacle; determining whether the reliability of the obstacle classification obtained is less than a preset value, and if so, viewing the obstacle Misclassification and filtering for classification, and vice versa, the reliability of obstacle classification for another obstacle is judged again.

本發明步驟中之融合計算係包括下列步驟:針對一特定障礙物,引入所有測距感測器偵測特定障礙物之分類信心度、準確度及障礙物連續偵測機率;根據特定障礙物之存在或不存在情況計算各測距感測器之信心度;特定障礙物包括空集合、存在、不存在、可能存在也可能不存在等四種偵測情況,將上一步驟之信心度代入,根據四種偵測情況計算一融合信心度;以及根據融合信心度計算融合後特定障礙物之一物體存在機率。 The fusion computing step in the step of the invention comprises the steps of: introducing, for a specific obstacle, all ranging sensors to detect the classification confidence, accuracy and the probability of continuous obstacle detection of a specific obstacle; according to the specific obstacle The presence or absence of the situation calculates the confidence of each ranging sensor; the specific obstacle includes four detection situations: empty set, presence, non-existence, possible existence or non-existence, and the confidence of the previous step is substituted. Calculate a fusion confidence based on the four detection conditions; and calculate the probability of existence of one of the specific obstacles after fusion based on the fusion confidence.

底下藉由具體實施例詳加說明,當更容易瞭解本發明之目的、技術內容、特點及其所達成之功效。 The purpose, technical content, features and effects achieved by the present invention will be more readily understood by the detailed description of the embodiments.

10‧‧‧攝影機 10‧‧‧ camera

11‧‧‧感測器 11‧‧‧ Sensor

12‧‧‧感測器 12‧‧‧ Sensors

13‧‧‧各自解析障礙物資訊 13‧‧‧Resolve obstacle information

14‧‧‧各自估算偵測信心度 14‧‧‧ respective estimates of confidence

15‧‧‧位置、分類融合資訊 15‧‧‧Location, classification and integration information

16‧‧‧偵測信心度融合 16‧‧‧Detective Convergence Fusion

17‧‧‧輸出資訊 17‧‧‧ Output information

18a‧‧‧車輛 18a‧‧ Vehicles

18b‧‧‧前車 18b‧‧‧Before the car

18c‧‧‧油罐車 18c‧‧‧ tanker

18d‧‧‧後車 18d‧‧‧ After the car

20‧‧‧影像擷取單元 20‧‧‧Image capture unit

22‧‧‧測距感測器 22‧‧‧Ranging sensor

24‧‧‧車身訊號感測器 24‧‧‧ Body Signal Sensor

26‧‧‧車用電腦 26‧‧‧Car computer

27‧‧‧分類器 27‧‧‧ classifier

28‧‧‧感知融合系統 28‧‧‧Perceptual Fusion System

第1圖為習知技術中偵測車前障礙物及感知融合之方塊圖。 Figure 1 is a block diagram of the detection of pre-vehicle obstacles and perceptual fusion in the prior art.

第2圖為利用習知技術之方法發生誤判之示意圖。 Figure 2 is a schematic diagram of misjudgment using methods of the prior art.

第3圖為本發明障礙物分類可靠度量化之方法之系統架構圖。 Figure 3 is a system architecture diagram of a method for reliably classifying obstacle classifications according to the present invention.

第4圖為本發明障礙物分類可靠度量化之方法之流程圖。 Figure 4 is a flow chart of a method for reliably classifying obstacle classifications according to the present invention.

第5圖為本發明中判斷障礙物連續偵測機率之流程圖。 Figure 5 is a flow chart for determining the probability of continuous detection of obstacles in the present invention.

第6圖為本發明中信心度融合之流程圖。 Figure 6 is a flow chart of the convergence of confidence in the present invention.

第7圖為本發明中分類失效過濾機制之流程圖。 Figure 7 is a flow chart of the classification failure filtering mechanism in the present invention.

本發明提供一種障礙物分類可靠度量化之方法,當各感測器分別偵測到前方有障礙物後,透過障礙物追蹤位置資訊、量化各感測器之偵測信心度,再結合各感測器之分類信心度,融合量化出障礙物分類可靠度,以供系統進行分類錯誤過濾,提升整體分類的精準度及可靠度。 The invention provides a method for reliably classifying obstacles. When each sensor detects an obstacle in front, it can track the position information through the obstacle, quantify the detection confidence of each sensor, and combine the senses. The classification confidence of the detector is combined to quantify the reliability of the obstacle classification, so that the system can perform classification error filtering to improve the accuracy and reliability of the overall classification.

第3圖所示為本發明障礙物分類可靠度量化之方法之系統架構圖,車輛之車用電腦26中包括一分類器27及一感知融合系統28,且車用電腦26連接一影像擷取單元20、一車身訊號感測器24及複數測距感測器22,測距感測器22為雷達或鐳射雷達(Lidar),會取得車輛前方至少一障礙物之障礙物資訊,影像擷取單元20可擷取到對應障礙物資訊之至少一影像資訊,而車身訊號感測器24則可得到複數車身訊號,包括車速、方向盤轉角等。 FIG. 3 is a system architecture diagram of a method for reliably classifying an obstacle classification according to the present invention. The vehicle computer 26 includes a classifier 27 and a perceptual fusion system 28, and the vehicle computer 26 is connected to an image capture system. The unit 20, a body signal sensor 24 and a plurality of ranging sensors 22, the distance measuring sensor 22 is a radar or a laser radar (Lidar), which acquires obstacle information of at least one obstacle in front of the vehicle, and captures the image. The unit 20 can capture at least one image information corresponding to the obstacle information, and the body signal sensor 24 can obtain multiple body signals, including the vehicle speed, the steering wheel angle and the like.

第4圖為本發明障礙物分類可靠度量化之方法之流程圖。步驟S10車用電腦接收至少一障礙物之障礙物資訊、對應障礙物資訊之至少一影像資訊及複數車身訊號,並利用一分類器對障礙物資訊、影像資訊及車身訊號進行類別分類,此分類器為車用電腦中之一功能模組;再如步驟S12所述,感知融合系統對測距感測器之偵測結果分別計算一偵測信心度,此偵測信心度代表測距感測器所偵測之障礙物為實體物的機率,每一個測距感測器都會針對障礙物得到偵測信心度,若偵測到多個障礙物,則會對應得到多個偵測信心度。在本發明中,偵測信心度係利用測距感測器分別針對當下偵測的障礙物進行座標追蹤,亦即得到障礙物之位置資訊,接著再將後續接收到之一實際值與追蹤值比對,以定義出所追蹤的障礙物於當下實際存在之機率,本發明將此機率視為偵測信心度。此障礙物之追蹤、比對及定義出偵測信心度係利用一共同綜合概率數據關聯(Joint Integrated Probabilistic Data Association,JIPDA)計算。 Figure 4 is a flow chart of a method for reliably classifying obstacle classifications according to the present invention. Step S10: The vehicle computer receives at least one obstacle obstacle information, at least one image information corresponding to the obstacle information, and a plurality of body signals, and classifies the obstacle information, the image information, and the body signal by using a classifier. The device is a function module in the vehicle computer; and as described in step S12, the sensing fusion system calculates a detection confidence for the detection result of the ranging sensor, and the detection confidence represents the ranging sensing. The obstacles detected by the device are the probability of physical objects. Each ranging sensor will detect the confidence of the obstacles. If multiple obstacles are detected, multiple detection confidences will be obtained. In the present invention, the detection confidence is performed by the ranging sensor for coordinate tracking of the obstacle currently detected, that is, the position information of the obstacle is obtained, and then one of the actual value and the tracking value is subsequently received. The comparison, in order to define the probability that the tracked obstacle actually exists in the present, the present invention regards this probability as detecting confidence. Tracking, comparing, and defining the confidence of the obstacle is calculated using a Joint Integrated Probabilistic Data Association (JIPDA).

接著,步驟S14讀取分類器之準確度,此準確度係由分類器開發者所訂定。 Next, step S14 reads the accuracy of the classifier, which is determined by the classifier developer.

步驟S16利用偵測信心度及上一步驟中所讀取之分類器準確度,計算每一測距感測器對應每一障礙物之一分類信心度,各測距感測器之分類信心度為偵測信心度乘以分類器準確度。 Step S16 uses the detection confidence level and the classifier accuracy read in the previous step to calculate the classification confidence of each obstacle corresponding to each obstacle sensor, and the classification confidence of each ranging sensor Multiply the confidence of the classifier by the confidence factor.

步驟S18中對所有分類信心度進行融合計算,分別量化所有測距感測器對每一障礙物之障礙物分類可靠度。在此步驟中,感知融合系統會先定義每一種障礙物的偵測情況,包括四種情況:{,{},{},{,}},其中代表空集合,{}代表障礙物存在,{}代表障礙物不存在,{,}代表障礙物可能存在也可能不存在,同時,需要三個參數才能計算一特定障礙物之障礙物分類可靠度,此三個參數包括每一測距感測器對應該特定障礙物之分類信心度、測距感測器之準確度及至少一障礙物連續偵測機率,其中,測距感測器之準確度為出廠時廠商所提供的準確率,每一個測距感測器的準確度不盡相同,一般而言準確度不可能達到100%,若使用者(駕駛者)覺得目前準確度與一開始的值不同,例如準確度降低,可手動調整該準確度,因此測距感測器之準確度為事先設定之預設數值,而障礙物連續偵測機率為測距感測器連續偵測到同一障礙物之機率,若車輛上設有影像擷取單元20,可直接從影像去判斷障礙物是否為車,此時測距感測器僅供輔助判斷,但若車輛並沒有影像擷取單元可擷取影像時,就只能完全靠測距感測器判斷,則此障礙物連續偵測機率之判斷方式如第5圖所示,假設欲判斷障礙物之分類是否為車,則包含下列步驟:步驟S30接收測距感測器所偵測之障礙物資訊;步驟S32比對和前一筆障礙物資訊中之障礙物是否為同一個,若否,則如步驟S34所述判別障礙物不是車,若是,則如步驟S36再判斷連續偵測到同一障礙物是否超過一預設次數,若連續偵測到同一障礙物超過預設次數,則如步驟S38所述判斷障礙物是車,若否,則如步驟S34所述判別障礙物不是車。 In step S18, all the classification confidence levels are combined and calculated, and the reliability of the obstacle classification of each obstacle sensor for each obstacle is quantized. In this step, the perceptual fusion system first defines the detection of each obstacle, including four cases: , { },{ },{ , }},among them Representative empty set, { } represents the presence of obstacles, { } means that the obstacle does not exist, { , } represents that the obstacle may or may not exist. At the same time, three parameters are required to calculate the obstacle classification reliability of a specific obstacle. The three parameters include the confidence of each ranging sensor in the classification of a specific obstacle. Degree, accuracy of the distance measuring sensor and at least one obstacle continuous detection probability, wherein the accuracy of the distance measuring sensor is the accuracy provided by the manufacturer at the factory, and the accuracy of each ranging sensor In general, the accuracy is unlikely to reach 100%. If the user (driver) feels that the current accuracy is different from the initial value, for example, the accuracy is reduced, the accuracy can be manually adjusted, so the distance sensing is performed. The accuracy of the device is a preset preset value, and the obstacle continuous detection probability is the probability that the ranging sensor continuously detects the same obstacle. If the image capturing unit 20 is provided on the vehicle, the image can be directly taken from the image. To determine whether the obstacle is a car, the distance sensor is only for auxiliary judgment. However, if the vehicle does not have an image capturing unit to capture the image, it can only be judged entirely by the distance measuring sensor. Material company The detection probability is determined as shown in FIG. 5, and if it is determined whether the classification of the obstacle is a vehicle, the following steps are included: Step S30 receives the obstacle information detected by the ranging sensor; and Step S32 compares and Whether the obstacle in the previous obstacle information is the same, if not, the obstacle is not the car as described in step S34, and if so, it is determined in step S36 whether the same obstacle is continuously detected for more than a predetermined number of times. If the same obstacle is continuously detected for more than the preset number of times, it is determined that the obstacle is a vehicle as described in step S38, and if not, the obstacle is determined not to be a vehicle as described in step S34.

步驟S18中之融合計算係以(Dempster-Shafer)理論進行融合, 用以將一特定障礙物的所有資訊融合,請參考第6圖之融合計算流程圖,包括下列步驟:步驟S182引入所有測距感測器偵測該特定障礙物之分類信心度、準確度及障礙物連續偵測機率;步驟S184根據特定障礙物之存在或不存在情況計算各測距感測器之信心度(basic belief assignment);步驟S186特定障礙物包括空集合、存在、不存在、可能存在也可能不存在等四種偵測情況,將步驟S184之信心度代入,根據四種偵測情況計算一融合信心度;以及步驟S188根據融合信心度計算融合後特定障礙物之一物體存在機率,此物體存在機率即為本發明中之障礙物分類可靠度。 The fusion calculation in step S18 is performed by the (Dempster-Shafer) theory. For the fusion of all the information of a specific obstacle, please refer to the fusion calculation flowchart of FIG. 6, including the following steps: Step S182 introduces all ranging sensors to detect the classification confidence, accuracy and the specific obstacle. The obstacle continuously detects the probability; step S184 calculates a basic belief assignment according to the presence or absence of the specific obstacle; step S186 includes the empty set, presence, nonexistence, possible There are four detection situations, such as the presence or absence of the above, the confidence level of the step S184 is substituted, and a fusion confidence is calculated according to the four detection conditions; and the step S188 calculates the existence probability of the object of the specific obstacle after the fusion according to the fusion confidence degree. The probability of existence of this object is the reliability of the classification of the obstacle in the present invention.

融合計算之公式如下:首先,步驟S182引入障礙物連續偵測機率、測距感測器之準確度、及每一測距感測器對應障礙物之分類信心度p i (x)。接著進行步驟S184計算各測距感測器之信心度,如下式(1)、(2): The formula of the fusion calculation is as follows: First, step S182 introduces the probability of continuous detection of obstacles. , the accuracy of the distance sensor And the confidence confidence of each obstacle sensor corresponding to the obstacle p i ( x). Then, step S184 is performed to calculate the confidence of each ranging sensor, as shown in the following formulas (1) and (2):

其中,m i ({})為障礙物存在時之信心度,m i ({})為障礙物不存在時之信心度。在此,僅採用障礙物存在{}及不存在{}兩種狀況,而不考慮空集合和障礙物可能存在也可能不存在{,}的狀況。 Where m i ({ }) the confidence level when the obstacle exists, m i ({ }) is the confidence level when the obstacle does not exist. Here, only obstacles exist { } and does not exist { } two conditions, regardless of the empty set And obstacles may or may not exist { , The status of }.

接著步驟S186計算融合信心度,同樣只採用{}和{}兩個集合,如下式(3),其中A={}、B={}: Then, in step S186, the fusion confidence is calculated, and only the { }with{ } two sets, as shown in the following equation (3), where A={ }, B={ }:

最後,再根據融合信心度計算融合後特定障礙物之一物體存在機率,如下式(4): 其中BelF({})為不考量無法判定障礙物存在或不存在之情況,PlF({})為考量無法判定障礙物存在或不存在之情況,此部分即為存在機率的加權,然後取各種情況的平均值,即得到障礙物的物體存在機率,亦即障礙物分類可靠度。 Finally, according to the fusion confidence, the probability of existence of one of the specific obstacles after fusion is calculated, as shown in the following formula (4): Where Bel F ({ }) In case of failure to determine the presence or absence of an obstacle, Pl F ({ }) In consideration of the inability to determine the presence or absence of an obstacle, this part is the weighting of the probability of existence, and then takes the average of the various conditions, that is, the probability of existence of the object that obtains the obstacle, that is, the reliability of the obstacle classification.

第4圖最後一個步驟如步驟S20所述,依據障礙物分類可靠度進行一分類失效過濾機制,當障礙物分類可靠度小於一預設值時,代表此障礙物之偵測或分類不可靠,因此感知融合系統會將此障礙物排除,具體流程請參考第7圖,步驟S202先擷取任一障礙物之障礙物分類可靠度,此障礙物分類可靠度是融合了所有測距感測器而得出的;接著步驟S204判斷所擷取之障礙物分類可靠度是否小於預設值,若是,則如步驟S206將障礙物視為分類誤判並過濾;反之,則回到步驟S202,擷取另一障礙物之障礙物分類可靠度再次進行判斷,直到車輛前方所偵測到的所有障礙物都進行過分類失效過濾機制為止。步驟S202更包括系統會以聽覺、觸覺或視覺方式告知該車輛之一駕駛者前方障礙物資訊,車用電腦更告知駕駛者該障礙物為車子或行人之機率,因此,若是自動輔助駕駛系統則可自動剎車。 The last step of FIG. 4 is as described in step S20, and a classification failure filtering mechanism is performed according to the obstacle classification reliability. When the obstacle classification reliability is less than a preset value, the detection or classification of the obstacle is unreliable. Therefore, the perceptual fusion system will exclude this obstacle. For the specific process, please refer to Figure 7. Step S202 first captures the obstacle classification reliability of any obstacle. The reliability of the obstacle classification is the fusion of all ranging sensors. And then, in step S204, it is determined whether the acquired obstacle classification reliability is less than a preset value, and if so, the obstacle is regarded as a classification misjudgment and filtered as in step S206; otherwise, the process returns to step S202 to capture The obstacle classification reliability of the other obstacle is judged again until all the obstacles detected in front of the vehicle have undergone the classification failure filtering mechanism. Step S202 further includes the system notifying the driver of obstacle information in front of the vehicle in an audible, tactile or visual manner, and the vehicle computer further informs the driver of the probability that the obstacle is a car or a pedestrian, and therefore, if the automatic assisted driving system is Can automatically brake.

在上述步驟S204中,障礙物分類可靠度之預設值可由駕駛者自行調整,舉例而言,若駕駛者啟動半自動駕駛時,預設值便需要調高,例如需達70%以上,以避免預設值調低時大多數障礙物都會被判定是車,而使車用電腦控制半自動駕駛系統不斷緊急剎車;而駕駛者自行開車,僅將障礙物分類可靠度做為輔助參考時,可將預設值調低,例如30~50%,如此一來感知融合系統雖然會經常發出前方障礙物是車、應減速或剎車的通知,但駕駛者可自行決定是否減速或剎車。 In the above step S204, the preset value of the obstacle classification reliability can be adjusted by the driver. For example, if the driver starts the semi-automatic driving, the preset value needs to be increased, for example, more than 70% is needed to avoid When the preset value is lowered, most obstacles will be judged to be the car, and the vehicle-controlled semi-automatic driving system will continue to brake urgently; while the driver drives the car and only uses the obstacle classification reliability as an auxiliary reference, The preset value is lowered, for example, 30~50%. As a result, the sensing fusion system often sends a notice that the front obstacle is a car, should be decelerated or braked, but the driver can decide whether to slow down or brake.

舉例而言,假設測距感測器為雷達,其偵測信心度為0.9999、分 類器準確度為0.87,則其分類信心度為0.9999*0.87=0.8699,而影像擷取單元之偵測信心度為0.94、分類器準確度為0.95,則其分類信心度為0.94*0.95=0.893;進行融合計算後得到之障礙物分類可靠度為0.895,擷取任一障礙物分類可靠度判斷是否大於一預設值,若預設值為0.6,由於0.895大於0.6,因此判斷障礙物為車輛成立,將此障礙物資訊告知駕駛者。 For example, if the ranging sensor is a radar, the detection confidence is 0.9999, and the score is The classifier accuracy is 0.87, and its classification confidence is 0.9999*0.87=0.8699, while the image capture unit has a detection confidence of 0.94 and the classifier accuracy is 0.95. The classification confidence is 0.94*0.95=0.893. The reliability of the obstacle classification obtained after the fusion calculation is 0.895, and the reliability of any obstacle classification is judged to be greater than a preset value. If the preset value is 0.6, since 0.895 is greater than 0.6, the obstacle is judged as a vehicle. Established to inform the driver of this obstacle information.

與先前技術相較之下,先前技術取得障礙物的偵測信心度及分類後,系統就會進行動作,但並未再次確認分類具有多高的可信度,當分類失效時,會導致將雜訊誤判為車輛而錯誤啟動安全機制,緊急剎車使後方來車發生追尾的狀況;反觀本發明之技術係先將測距感測器偵測到障礙物為實體物的機率進行量化(亦即偵測信心度),接著利用偵測信心度及分類器準確度計算出分類信心度,最後增加了融合量化障礙物分類可靠度之機制,修正了原有的分類失效的問題,提升分類精準度,避免後端系統誤作動,且即使沒有影像也可以依靠雷達、鐳射雷達等測距感測器進行障礙物分類,不會因為沒有影像就失去防護能力,大幅提升分類可靠度及駕駛安全性。 Compared with the prior art, after the prior art obtains the confidence and classification of the obstacles, the system will act, but does not reconfirm the high degree of credibility of the classification. When the classification fails, it will lead to The noise is misjudged as a vehicle and the safety mechanism is erroneously activated. The emergency brake causes the rear vehicle to catch up. In contrast, the technique of the present invention first quantifies the probability that the distance measuring sensor detects the obstacle as a physical object (ie, Detecting confidence), then using the confidence of confidence and the accuracy of the classifier to calculate the confidence of the classification, and finally increasing the mechanism of the reliability of the classification of the quantitative obstacles, correcting the problem of the original classification failure, and improving the classification accuracy. To avoid misoperation of the back-end system, and even if there is no image, it can rely on radar, laser radar and other ranging sensors to classify obstacles. It will not lose its protection ability because there is no image, and greatly improve classification reliability and driving safety.

唯以上所述者,僅為本發明之較佳實施例而已,並非用來限定本發明實施之範圍。故即凡依本發明申請範圍所述之特徵及精神所為之均等變化或修飾,均應包括於本發明之申請專利範圍內。 The above is only the preferred embodiment of the present invention and is not intended to limit the scope of the present invention. Therefore, any changes or modifications of the features and spirits of the present invention should be included in the scope of the present invention.

Claims (12)

一種障礙物分類可靠度量化之方法,其應用於車輛之一車用電腦中之一感知融合系統,該車用電腦連接一影像擷取單元、一車身訊號感測器及複數測距感測器,該方法包括下列步驟:該車用電腦接收至少一障礙物之障礙物資訊、對應該障礙物資訊之至少一影像資訊及複數車身訊號,並利用一分類器對該障礙物資訊、該影像資訊及該等車身訊號進行類別分類;該感知融合系統對該等測距感測器之偵測結果分別計算一偵測信心度;利用該等偵測信心度及該分類器之一準確度計算每一該等測距感測器對應每一該等障礙物之一分類信心度;對所有之該等分類信心度進行融合計算,分別量化所有該測距感測器對每一該等障礙物之一障礙物分類可靠度,該融合計算包括下列步驟:利用該等分類信心度、該等測距感測器之準確度及至少一障礙物連續偵測機率計算出該等測距感測器之一信心度;再根據該等測距感測器之該信心度計算一融合信心度;以及根據該融合信心度計算融合後該特定障礙物之一物體存在機率;以及依據該障礙物分類可靠度進行一分類失效過濾機制,排除該障礙物分類可靠度小於一預設值之該障礙物。 A method for reliably classifying an obstacle classification, which is applied to a sensing fusion system of a vehicle computer, which is connected to an image capturing unit, a body signal sensor and a plurality of ranging sensors The method includes the following steps: the vehicle computer receives at least one obstacle obstacle information, at least one image information corresponding to the obstacle information, and a plurality of body signals, and uses a classifier to information about the obstacle and the image information. And classifying the body signals; the sensing fusion system respectively calculates a detection confidence for the detection results of the ranging sensors; and calculating the confidence by using the detection confidence and the accuracy of the classifier One of the ranging sensors classifies confidence corresponding to one of each of the obstacles; and performs fusion calculation on all of the class confidences to quantify all of the ranging sensors for each of the obstacles An obstacle classification reliability, the fusion calculation comprising the steps of: utilizing the classification confidence, the accuracy of the ranging sensors, and the at least one obstacle continuous detection probability calculation Calculating a confidence level according to the confidence of the distance measuring sensors; and calculating a probability of existence of an object of the specific obstacle after the fusion according to the fusion confidence; And performing a classification failure filtering mechanism according to the obstacle classification reliability, and removing the obstacle whose reliability is less than a preset value. 如請求項1所述之障礙物分類可靠度量化之方法,其中該偵測信心度係利用該等測距感測器分別針對當下偵測的該等障礙物進行座標追蹤,再將後續接收到之一實際值與複數追蹤值比對,以定義出所追 蹤的該障礙物於當下實際存在之機率。 The method for reliably classifying the obstacle classification according to claim 1, wherein the detecting confidence is performed by using the ranging sensors respectively for coordinate tracking of the obstacles currently detected, and then receiving the subsequent One of the actual values is compared with the complex tracking value to define the chasing The probability that the obstacle is actually present in the moment. 如請求項2所述之障礙物分類可靠度量化之方法,其中該等障礙物之追蹤、比對及定義出該偵測信心度係利用一共同綜合概率數據關聯(Joint Integrated Probabilistic Data Association,JIPDA)計算。 A method for reliably classifying obstacle classification according to claim 2, wherein tracking, comparing, and defining the confidence of the obstacles are related using a common integrated probability data (Joint Integrated Probabilistic Data Association, JIPDA) ) Calculation. 如請求項1所述之障礙物分類可靠度量化之方法,其中該偵測信心度為該等測距感測器所偵測之該等障礙物為實體物的機率。 The method for reliably classifying obstacles according to claim 1, wherein the detection confidence is a probability that the obstacles detected by the ranging sensors are physical objects. 如請求項1所述之障礙物分類可靠度量化之方法,其中該障礙物連續偵測機率為該等測距感測器連續偵測到同一該障礙物之機率。 The method for reliably classifying an obstacle classification according to claim 1, wherein the obstacle continuous detection probability is a probability that the ranging sensors continuously detect the same obstacle. 如請求項1或5所述之障礙物分類可靠度量化之方法,其中該障礙物連續偵測機率之判斷方式包含下列步驟:接收該測距感測器所偵測之該等障礙物資訊;比對和前一筆該障礙物資訊中之該障礙物是否為同一個,若否,則判別該障礙物不是車,若是,再判斷連續偵測到同一該障礙物是否超過一預設次數;以及若連續偵測到同一該障礙物超過該預設次數,則判斷該障礙物是車,若否,則判別該障礙物不是車。 The method for reliably classifying obstacles according to claim 1 or 5, wherein the method for judging the probability of continuous detection of the obstacle comprises the steps of: receiving the obstacle information detected by the ranging sensor; Comparing with the previous one of the obstacle information in the obstacle information is the same one, if not, determining that the obstacle is not a car, and if so, determining whether the same obstacle is continuously detected for more than a preset number of times; If it is continuously detected that the same obstacle exceeds the preset number of times, it is determined that the obstacle is a vehicle, and if not, it is determined that the obstacle is not a vehicle. 如請求項1所述之障礙物分類可靠度量化之方法,其中該等測距感測器之準確度為事先設定之預設數值。 The method for reliably classifying obstacle classification according to claim 1, wherein the accuracy of the ranging sensors is a preset value set in advance. 如請求項1所述之障礙物分類可靠度量化之方法,其中該分類失效過濾機制係包括下列步驟:擷取任一該障礙物之該障礙物分類可靠度;判斷所擷取之該障礙物分類可靠度是否小於該預設值;以及若是,則將該障礙物視為分類誤判並過濾,反之,則擷取另一該障礙物之該障礙物分類可靠度再次進行判斷。 The method for reliably classifying an obstacle classification according to claim 1, wherein the classification failure filtering mechanism comprises the following steps: capturing the reliability of the obstacle classification of any of the obstacles; and determining the obstacle to be taken Whether the classification reliability is less than the preset value; and if so, the obstacle is regarded as a misclassification and filtering, and vice versa, the obstacle classification reliability of the other obstacle is again determined. 如請求項1所述之障礙物分類可靠度量化之方法,其中該分類失效過濾機制中,當該障礙物分類可靠度大於等於該預設值時,以聽覺、觸覺或視覺方式告知該車輛之一駕駛者前方之該障礙物資訊。 The method for reliably classifying an obstacle classification according to claim 1, wherein in the classification failure filtering mechanism, when the obstacle classification reliability is greater than or equal to the preset value, the vehicle is notified in an audible, tactile or visual manner. The obstacle information in front of the driver. 如請求項9所述之障礙物分類可靠度量化之方法,其中該分類失效過濾機制中,當該障礙物分類可靠度大於等於該預設值時,該車用電腦更告知該駕駛者該障礙物為車子或行人之機率。 The method for reliably classifying an obstacle classification according to claim 9, wherein in the classification failure filtering mechanism, when the obstacle classification reliability is greater than or equal to the preset value, the vehicle computer further informs the driver of the obstacle The probability of being a car or a pedestrian. 如請求項1所述之障礙物分類可靠度量化之方法,其中該等測距感測器為雷達或鐳射雷達(Lidar)。 The method for reliably classifying obstacle classification according to claim 1, wherein the ranging sensors are radar or laser radar (Lidar). 如請求項1所述之障礙物分類可靠度量化之方法,其中利用該等分類信心度、該等測距感測器之準確度及該障礙物連續偵測機率計算出該等測距感測器之該信心度之步驟,係針對該等障礙物其中之一特定障礙物,該特定障礙物包括空集合、存在、不存在、可能存在也可能不存在等四種偵測情況,將該等測距感測器之該信心度代入,根據該四種偵測情況計算該融合信心度。 The method for reliably classifying obstacle classification according to claim 1, wherein the distance sensing is calculated by using the classification confidence, the accuracy of the ranging sensors, and the probability of continuous detection of the obstacle. The step of confidence is a specific obstacle for one of the obstacles, including the empty detection, presence, non-existence, possible existence or non-existence, and the like. The confidence of the ranging sensor is substituted, and the fusion confidence is calculated according to the four detection conditions.
TW104140639A 2015-12-04 2015-12-04 Method of quantifying the reliability of obstacle classification TWI559267B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW104140639A TWI559267B (en) 2015-12-04 2015-12-04 Method of quantifying the reliability of obstacle classification

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW104140639A TWI559267B (en) 2015-12-04 2015-12-04 Method of quantifying the reliability of obstacle classification

Publications (2)

Publication Number Publication Date
TWI559267B true TWI559267B (en) 2016-11-21
TW201721608A TW201721608A (en) 2017-06-16

Family

ID=57851731

Family Applications (1)

Application Number Title Priority Date Filing Date
TW104140639A TWI559267B (en) 2015-12-04 2015-12-04 Method of quantifying the reliability of obstacle classification

Country Status (1)

Country Link
TW (1) TWI559267B (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI646306B (en) * 2017-12-15 2019-01-01 財團法人車輛研究測試中心 Method for analyzing error and existence probability of multi-sensor fusion of obstacle detection
TWI645997B (en) * 2017-12-20 2019-01-01 財團法人車輛研究測試中心 Obstacle detection credibility evaluation method
CN109932721A (en) * 2017-12-15 2019-06-25 财团法人车辆研究测试中心 Error and detecting probability analysis method applied to the fusion of more sensors
CN112804278A (en) * 2019-11-14 2021-05-14 黄玄 Traffic road condition car networking system based on image is discerned
CN113844463A (en) * 2021-09-26 2021-12-28 国汽智控(北京)科技有限公司 Vehicle control method and device based on automatic driving system and vehicle
CN117698711A (en) * 2024-02-06 2024-03-15 江苏日盈电子股份有限公司 Intelligent automobile radar ranging control system based on Internet of things

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1406790A (en) * 2001-09-07 2003-04-02 松下电器产业株式会社 Surroundings display device of vehicle and image prompt system
US20060111841A1 (en) * 2004-11-19 2006-05-25 Jiun-Yuan Tseng Method and apparatus for obstacle avoidance with camera vision
EP2085944A1 (en) * 2006-11-10 2009-08-05 Aisin Seiki Kabushiki Kaisha Driving assistance device, driving assistance method, and program
TW201422473A (en) * 2012-12-04 2014-06-16 Automotive Res & Testing Ct Collision prevention warning method capable of tracing movable objects and device thereof

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1406790A (en) * 2001-09-07 2003-04-02 松下电器产业株式会社 Surroundings display device of vehicle and image prompt system
US20060111841A1 (en) * 2004-11-19 2006-05-25 Jiun-Yuan Tseng Method and apparatus for obstacle avoidance with camera vision
EP2085944A1 (en) * 2006-11-10 2009-08-05 Aisin Seiki Kabushiki Kaisha Driving assistance device, driving assistance method, and program
TW201422473A (en) * 2012-12-04 2014-06-16 Automotive Res & Testing Ct Collision prevention warning method capable of tracing movable objects and device thereof

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI646306B (en) * 2017-12-15 2019-01-01 財團法人車輛研究測試中心 Method for analyzing error and existence probability of multi-sensor fusion of obstacle detection
CN109932721A (en) * 2017-12-15 2019-06-25 财团法人车辆研究测试中心 Error and detecting probability analysis method applied to the fusion of more sensors
CN109932721B (en) * 2017-12-15 2023-09-29 财团法人车辆研究测试中心 Error and detection probability analysis method applied to multi-sensor fusion
TWI645997B (en) * 2017-12-20 2019-01-01 財團法人車輛研究測試中心 Obstacle detection credibility evaluation method
CN112804278A (en) * 2019-11-14 2021-05-14 黄玄 Traffic road condition car networking system based on image is discerned
CN113844463A (en) * 2021-09-26 2021-12-28 国汽智控(北京)科技有限公司 Vehicle control method and device based on automatic driving system and vehicle
CN117698711A (en) * 2024-02-06 2024-03-15 江苏日盈电子股份有限公司 Intelligent automobile radar ranging control system based on Internet of things
CN117698711B (en) * 2024-02-06 2024-04-26 江苏日盈电子股份有限公司 Intelligent automobile radar ranging control system based on Internet of things

Also Published As

Publication number Publication date
TW201721608A (en) 2017-06-16

Similar Documents

Publication Publication Date Title
TWI559267B (en) Method of quantifying the reliability of obstacle classification
CN105372654B (en) The method of the reliable metrization of obstacle classification
US9785846B2 (en) Method for quantifying classification confidence of obstructions
CN106485233B (en) Method and device for detecting travelable area and electronic equipment
JP6266238B2 (en) Approaching object detection system and vehicle
JP5690688B2 (en) Outside world recognition method, apparatus, and vehicle system
EP3161507B1 (en) Method for tracking a target vehicle approaching a motor vehicle by means of a camera system of the motor vehicle, camera system and motor vehicle
JP2006284293A (en) Device and method for detecting target for car
US11577721B2 (en) System and method for detecting a risk of collision between a motor vehicle and a secondary object located in the traffic lanes adjacent to said vehicle when changing lanes
CN105128836A (en) Autonomous emergency braking system and method for recognizing pedestrian therein
JP6856452B2 (en) Target judgment device and driving support system
US20140218508A1 (en) System, method, and computer-readable recording medium for lane keeping control
CN110194152B (en) Autonomous emergency braking system and method for a vehicle at an intersection
JP5907700B2 (en) Image processing apparatus, vehicle system, and image processing method
JP2008276689A (en) Obstacle-recognition device for vehicle
JP2008117073A (en) Interruption vehicle detection device
CN108960083B (en) Automatic driving target classification method and system based on multi-sensor information fusion
CN107139921B (en) A kind of steering collision-proof method and system for vehicle
US11474535B2 (en) Method of processing data, apparatus for processing data, and system for controlling vehicle
US11420624B2 (en) Vehicle control apparatus and vehicle control method
KR20100056883A (en) An adaptive cruise control system sensing a wedging vehicle
US20150269732A1 (en) Obstacle detection device
KR20160131196A (en) Device for detecting an obstacle
US11667295B2 (en) Apparatus and method for recognizing object
JP2021196789A (en) Inter-vehicle distance measurement device and vehicle control system