TW201724050A - Vehicle cooperative object positioning optimization method and vehicle cooperative positioning apparatus for extending a sensing range of a vehicle and improving the accuracy of positioning information so as to enhance vehicle driving safety - Google Patents

Vehicle cooperative object positioning optimization method and vehicle cooperative positioning apparatus for extending a sensing range of a vehicle and improving the accuracy of positioning information so as to enhance vehicle driving safety Download PDF

Info

Publication number
TW201724050A
TW201724050A TW104142232A TW104142232A TW201724050A TW 201724050 A TW201724050 A TW 201724050A TW 104142232 A TW104142232 A TW 104142232A TW 104142232 A TW104142232 A TW 104142232A TW 201724050 A TW201724050 A TW 201724050A
Authority
TW
Taiwan
Prior art keywords
vehicle
coordinates
coordinate
optimization
original
Prior art date
Application number
TW104142232A
Other languages
Chinese (zh)
Other versions
TWI584238B (en
Inventor
李朝陽
張哲誠
Original Assignee
財團法人車輛研究測試中心
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 by 財團法人車輛研究測試中心 filed Critical 財團法人車輛研究測試中心
Priority to TW104142232A priority Critical patent/TWI584238B/en
Application granted granted Critical
Publication of TWI584238B publication Critical patent/TWI584238B/en
Publication of TW201724050A publication Critical patent/TW201724050A/en

Links

Landscapes

  • Traffic Control Systems (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

A vehicle cooperative object positioning optimization method is disclosed, which comprises: receiving an information packet from a local vehicle, wherein the information packet includes an original vehicle coordinate and at least one original object coordinate provided by a neighbor vehicle, and respective positioning accuracies; performing a time delay compensation for the original vehicle coordinate and the original object coordinate to respectively acquire a vehicle coordinate and an object coordinate of the neighbor vehicle after the compensation; and performing an optimization procedure to respectively optimize the vehicle coordinate and the object coordinate so as to respectively obtain an optimized vehicle coordinate and an optimized object coordinate. Therefore, the optimized vehicle coordinate and the optimized object coordinate have higher accuracy than the coordinate information detected by a GPS receiver, so as to determine precisely a distribution of environmental objects and enhance driving safety.

Description

車輛協同式物體定位優化方法及車輛協同定位裝置Vehicle coordinated object positioning optimization method and vehicle cooperative positioning device

本創作是一種物體定位方法,特別是指一種協同式物體定位(Cooperative positioning)優化方法。This creation is an object positioning method, especially a cooperative object positioning (Cooperative positioning) optimization method.

在車輛中配置感測器(sensor)以偵測周圍環境的相關技術已發展許久,例如使用全球定位系統(GPS)、雷達(RADAR)、光達(LIDAR)、行車紀錄器等不同感測器可提供多元的環境資訊。但是對車輛本身而言,透過環境資訊感測器所取得的環境資訊仍會受到許多因素的限制,舉例而言,請參考圖9所示,在十字路口的環境中,行駛在縱向車道的第一車輛101可得知該方向之環境資訊,例如可看到有物體200(如行人、車輛、動物)正快速衝出路口,但對於在橫向車道的第二車輛102而言,因受限於其所在位置可能受周圍建築物遮蔽而產生盲點,即使第二車輛102上具有感測器,但仍無法察覺該物體200的突發情況而與其撞擊。因此,若僅單獨依據車輛本身的感測器提供環境資訊,在實際應用時仍存在有盲點。Related technologies for configuring sensors in vehicles to detect the surrounding environment have been developed for a long time, such as using different sensors such as Global Positioning System (GPS), Radar (RADAR), LIDAR, and Travel Recorder. Provide diverse environmental information. However, for the vehicle itself, the environmental information obtained through the environmental information sensor will still be limited by many factors. For example, please refer to Figure 9, in the environment of the intersection, in the longitudinal lane A vehicle 101 can know the environmental information of the direction. For example, it can be seen that an object 200 (such as a pedestrian, a vehicle, or an animal) is rapidly rushing out of the intersection, but for the second vehicle 102 in the lateral lane, it is limited by The location thereof may be obscured by surrounding buildings to create a blind spot, even if the second vehicle 102 has a sensor, it is still unable to detect the sudden occurrence of the object 200 and collide with it. Therefore, if the environmental information is provided solely on the basis of the sensor of the vehicle itself, there is still a blind spot in actual application.

為此,車輛協同式定位方法遂發展出來,協同式的概念係表示透過周圍其鄰車輛或周圍的感測裝置(例如路側感測單元(Road side unit), RSU)分享各自感測到的資訊,使本車接收其它車輛的資訊而擴增自己的感測範圍,沿用上述圖9的例子說明,若該第二車輛102可接收該第一車輛提供的資訊,便可得知其右方路口將有物體突然出現,有足夠的時間緊急應變。To this end, the vehicle cooperative positioning method has been developed. The concept of collaborative design means sharing the information sensed by surrounding neighboring vehicles or surrounding sensing devices (such as the road side unit, RSU). Having the vehicle receive information of other vehicles and amplifying its own sensing range. According to the example of FIG. 9 above, if the second vehicle 102 can receive the information provided by the first vehicle, the right intersection can be known. Some objects will suddenly appear and there will be enough time for emergency response.

然而目前協同式定位技術係面臨準確性不佳的技術缺點,請參考圖10所示範例,第一車輛101表示本車,第二車輛102~第四車輛104表示鄰近的其它車輛。以第二車輛102而言,其配備有一商用GPS及一攝影機,而一般商用GPS的定位誤差約為5~15公尺,攝影機的定位誤差約為5公尺,因此,該第二車輛102利用自身GPS所測得之自身位置具有一GPS誤差範圍A1,第二車輛102利用攝影機感測到第三車輛103之所在位置時,由攝影機所測得之第三車輛103位置具有一攝影機誤差範圍A2;因此,若第二車輛102將其感測到之第三車輛的位置資訊轉傳分享給第一車輛101時,第一車輛101所接收到的第三車輛103的位置資訊即有誤差累積的問題,如GPS及攝影機累加誤差範圍A3所示。However, the current collaborative positioning technology is faced with technical disadvantages of poor accuracy. Referring to the example shown in FIG. 10, the first vehicle 101 represents the vehicle, and the second vehicle 102 to the fourth vehicle 104 represent other vehicles in the vicinity. In the case of the second vehicle 102, it is equipped with a commercial GPS and a camera, and the positioning error of the general commercial GPS is about 5 to 15 meters, and the positioning error of the camera is about 5 meters. Therefore, the second vehicle 102 utilizes The position measured by the own GPS has a GPS error range A1. When the second vehicle 102 senses the position of the third vehicle 103 by the camera, the position of the third vehicle 103 measured by the camera has a camera error range A2. Therefore, if the second vehicle 102 relays the location information of the third vehicle that it senses to the first vehicle 101, the location information of the third vehicle 103 received by the first vehicle 101 is accumulated by error. Problems such as GPS and camera accumulation error range A3.

再進一步而言,若第一車輛101將該筆第三車輛103的位置資訊二度轉傳分享給第四車輛104時,將會再進一步加上第一車輛101自身的位置誤差,導致第四車輛104所接收之位置資訊產生更多的累積誤差量。因此,當資訊經過多次的轉傳分享後,對物體的定位準確性將會顯著下降,甚至不具參考價值。Further, if the first vehicle 101 transmits the position information of the third vehicle 103 twice to the fourth vehicle 104, the position error of the first vehicle 101 itself is further added, resulting in the fourth vehicle. The position information received by the vehicle 104 produces a greater amount of accumulated error. Therefore, when the information is transferred and shared many times, the accuracy of positioning the object will be significantly reduced, and even has no reference value.

鑑於既有協同式定位技術存在有位置資訊精確度不佳的問題,本創作之主要目的是提供一種車輛協同式物體定位優化方法,以擴增車輛的感範圍、提高位置資訊的精準度而提升車輛行駛的安全性。In view of the problem that the existing collaborative positioning technology has poor positional information accuracy, the main purpose of this creation is to provide a vehicle coordinated object positioning optimization method, which can enhance the sensing range of the vehicle and improve the accuracy of the position information. The safety of the vehicle.

為達到前述目的,本發明之方法係利用一設置在本車內部之協同定位裝置執行,該方法包含有: 由本車接收一資訊封包,該資訊封包中包含一鄰車提供的車輛原始座標及至少一物體原始座標,該車輛原始座標及該物體原始座標分別具有各自之定位精準度; 對該車輛原始座標及物體原始座標進行時間延遲補償,以分別得到鄰車補償後的一車輛座標及一物體座標; 執行一優化程序,其包含: 比對本車的車輛座標與鄰車的車輛座標,判斷何者具有較高的定位精準度; 優先對具有較高精準度的車輛座標進行一優化運算,再對具有較低定位精準度的車輛座標進行優化運算,其中,該優化運算執行: a) 根據本車的車輛座標與鄰車的車輛座標計算出複數個參考位置;及 b) 根據各參考位置之權重值,計算出一車輛優化座標; 對物體座標進行優化,係比較鄰車的原始車輛座標及其車輛優化座標之間的差異量,依據該差異量對鄰車提供之物體座標進行補償以得到一物體優化座標;並比較本車的原始車輛座標及本車的車輛優化座標之間的差異量,依該差異量對本車提供之物體座標進行補償以得到一物體優化座標。To achieve the foregoing objective, the method of the present invention is performed by a co-location device disposed inside the vehicle, the method comprising: receiving, by the vehicle, an information packet, the information packet including an original coordinate of the vehicle provided by the neighboring vehicle and at least The original coordinate of an object, the original coordinates of the vehicle and the original coordinates of the object respectively have their own positioning accuracy; time delay compensation is performed on the original coordinates of the vehicle and the original coordinates of the object to obtain a vehicle coordinate and an object compensated by the adjacent vehicle respectively. Coordinates; perform an optimization procedure, which includes: comparing the vehicle coordinates of the vehicle with the vehicle coordinates of the adjacent vehicle to determine which has higher positioning accuracy; preferentially performing an optimization operation on the vehicle coordinates with higher precision, and then The vehicle coordinates with lower positioning accuracy are optimized, wherein the optimization operation is performed: a) calculating a plurality of reference positions according to the vehicle coordinates of the vehicle and the vehicle coordinates of the adjacent vehicle; and b) weighting according to each reference position Value, calculate a vehicle optimization coordinate; optimize the object coordinates, compare the neighboring cars The difference between the original vehicle coordinates and the optimized coordinates of the vehicle, the object coordinates provided by the neighboring vehicle are compensated according to the difference amount to obtain an object optimization coordinate; and the original vehicle coordinates of the vehicle and the vehicle optimized coordinates of the vehicle are compared The amount of difference between the vehicles is compensated for the object coordinates provided by the vehicle to obtain an object optimization coordinate.

藉由本創作的定位優化方法,可獲得本車及鄰車優化後的車輛座標、物體座標,該優化後的座標可更加接近實際化置,有助於在行車過程中準確地判斷周圍環境的物體、車輛分佈狀態,提升車輛行駛的安全性。With the positioning optimization method of this creation, the optimized vehicle coordinates and object coordinates of the vehicle and the adjacent car can be obtained, and the optimized coordinates can be closer to the actual setting, which helps to accurately judge the surrounding environment during the driving process. The vehicle distribution status improves the safety of the vehicle.

請參考圖1所示,本創作利用配備在各車輛上的一車身感知器15,包含GPS接收器及其它多種感測器,例如雷達、攝影機等設備取得本車座標與車輛周圍之環境資訊,並透過無線通訊技術將本車座標與環境資訊轉傳分享給周圍的鄰近車輛。因此,就任何一台車輛而言,係與周圍車輛進行接收及傳輸的雙向無線通訊。Referring to FIG. 1 , the present invention utilizes a vehicle body sensor 15 provided on each vehicle, including a GPS receiver and various other sensors, such as radars, cameras, and the like to obtain environmental information of the coordinates of the vehicle and the surroundings of the vehicle. And through the wireless communication technology, the car coordinates and environmental information will be transferred to the surrounding neighboring vehicles. Therefore, in any vehicle, it is a two-way wireless communication that receives and transmits with surrounding vehicles.

本創作在車輛內部設置一車輛協同定位裝置10,該車輛協同定位裝置10包含有一無線傳輸介面11、一延遲修正模組12、一位置優化模組13及一定位比對模組14。該車輛協同定位裝置10係執行一車輛協同式物體定位優化方法,該方法如圖2所示,包含有以下步驟:The vehicle co-locating device 10 is disposed in the vehicle. The vehicle co-location device 10 includes a wireless transmission interface 11 , a delay correction module 12 , a position optimization module 13 , and a positioning comparison module 14 . The vehicle co-location device 10 performs a vehicle coordinated object positioning optimization method. The method is as shown in FIG. 2 and includes the following steps:

S10:接收一資訊封包,該資訊封包中包含鄰車的一車輛原始座標及至少一物體原始座標以及該車輛原始座標與物體原始座標各自之定位精準度;S10: receiving an information packet, where the information packet includes an original coordinate of a vehicle of the adjacent vehicle and at least one original coordinate of the object, and a positioning accuracy of the original coordinate of the vehicle and the original coordinate of the object;

S20:對該車輛原始座標及物體原始座標進行時間延遲補償,以分別得到鄰車補償後的的一車輛座標及一物體座標;S20: performing time delay compensation on the original coordinates of the vehicle and the original coordinates of the object to obtain a vehicle coordinate and an object coordinate compensated by the adjacent vehicle respectively;

S30:執行一優化程序;S30: executing an optimization program;

S40:座標比對融合。S40: Coordinates are merged.

在步驟S10:該無線傳輸介面11負責本車與鄰車之間的資料雙向傳輸,在本實施例中是採用一短距無線通訊介面(DSRC),於車輛之間週期性地收發資料封包,資料封包格式是採用基本安全訊息(Basic Safety Message, BSM)封包,請參考圖3,該資料封包的訊息格式大致上包含一msgID欄位、第一部分21(Part I)及第二部分22(Part II),其中第一部分21係定義為必要資訊,包含基本的安全訊息內容,為每個資料封包必然包含的部分,但第二部分22為非必要部分(optional),可由使用者視應用需求將所需的資訊加入在第二部分22,屬於自行定義的範圍。In step S10, the wireless transmission interface 11 is responsible for bidirectional transmission of data between the vehicle and the adjacent vehicle. In this embodiment, a short-range wireless communication interface (DSRC) is used to periodically send and receive data packets between vehicles. The data packet format is a Basic Safety Message (BSM) packet. Please refer to Figure 3. The message format of the data packet generally includes a msgID field, the first part 21 (Part I) and the second part 22 (Part II), wherein the first part 21 is defined as the necessary information, including the basic security message content, and the part that is inevitably included for each data packet, but the second part 22 is optional, which can be viewed by the user depending on the application requirements. The required information is added to the second part 22, which is a self-defined range.

在BSM資料封包的第一部分21中,即必然存在有車輛的經緯度資訊,也就是車輛的原始座標,表示利用車輛內的GPS接收器所測得的本車位置。In the first part 21 of the BSM data packet, there is necessarily a latitude and longitude information of the vehicle, that is, the original coordinates of the vehicle, indicating the position of the vehicle measured by the GPS receiver in the vehicle.

在BSM資料封包中的第二部分22中,本創作加入兩類資訊,第一類資訊為輸出該車輛原始座標的感測器種類(例如RTK、GPS)及該感測器的定位精準度。第二類資訊包含有物體(object)原始座標、產生該物體原始座標的感測器種類、或進一步包含該感測器的精準度,該物體原始座標是指利用本車之其它感測器(例如radar, lidar, camera等)感測本車以外的其它物體的資訊,該物體可能是車輛、行人、移動物或固定物等。各車輛可將本車的車輛原始座標與物體原始座標對外發送,供周圍鄰車利用;而本車同樣可接收來自周圍鄰車提供的車輛原始座標與物體原始座標。In the second part 22 of the BSM data package, the author adds two types of information. The first type of information is the sensor type (such as RTK, GPS) that outputs the original coordinates of the vehicle and the positioning accuracy of the sensor. The second type of information includes the original coordinates of the object, the type of sensor that produces the original coordinates of the object, or the accuracy of the sensor. The original coordinate of the object refers to the use of other sensors of the vehicle ( For example, radar, lidar, camera, etc.) sense information about objects other than the vehicle, which may be vehicles, pedestrians, moving objects or fixtures. Each vehicle can send the original coordinates of the vehicle and the original coordinates of the object to the surrounding neighboring vehicles for use; and the vehicle can also receive the original coordinates of the vehicle and the original coordinates of the object provided by the surrounding neighboring vehicles.

在步驟S20:該延遲修正模組12透過該無線傳輸介面11接收鄰車傳輸出來的的BSM資料封包,獲得鄰車的車輛原始座標與物體原始座標,此外,該位置優化模組13也進一步接收本車的感測器提供的各種感測結果,例如車輛座標(GPS)、物體座標。該延遲修正模組12針對鄰車提供的車輛原始座標與物體原始座標進行時間延遲補償,請參考圖4所示,一第一車輛101表示本車,在其附近的一第二車輛102表示鄰車,當第一車輛101接收到第二車輛102發出的資料封包時,第一車輛101可根據紀錄在封包內的一封包發出時間及其本身接收到該封包時的一封包接收時間,計算出該封包發出時間及封包接收時間之間的一時間延遲量n。因為第二車輛102在送出封包後,仍持續行駛前進由原始位置PA 到位置PB ,因此第一車輛101所接收到的第二車輛102原始座標只是代表原始位置PA ,而延遲修正模組12即根據該時間延遲量n推算第二車輛102所移動的一補償距離,加上該補償距離而得知即時位置PB ,其推算公式可表示如下: PB =PA +V × n,其中,V代表第二車輛102的車速。In step S20, the delay correction module 12 receives the BSM data packet transmitted by the neighboring vehicle through the wireless transmission interface 11, and obtains the original coordinate of the adjacent vehicle and the original coordinate of the object, and further, the position optimization module 13 further receives the The sensors provided by the vehicle provide various sensing results, such as vehicle coordinates (GPS) and object coordinates. The delay correction module 12 performs time delay compensation for the original coordinate of the vehicle provided by the adjacent vehicle and the original coordinate of the object. Referring to FIG. 4, a first vehicle 101 represents the vehicle, and a second vehicle 102 in the vicinity thereof represents the neighbor. In the vehicle, when the first vehicle 101 receives the data packet sent by the second vehicle 102, the first vehicle 101 can calculate the time according to the time when a packet is recorded in the packet and the time when the packet is received by the packet itself. A time delay amount n between the packet issuance time and the packet reception time. Since the second vehicle 102 continues to travel forward from the original position P A to the position P B after the packet is sent out, the original coordinates of the second vehicle 102 received by the first vehicle 101 are only representative of the original position P A , and the delay correction mode The group 12 estimates a compensation distance moved by the second vehicle 102 according to the time delay amount n, and adds the compensation distance to know the instantaneous position P B , and the calculation formula can be expressed as follows: P B =P A +V × n Where V represents the vehicle speed of the second vehicle 102.

當延遲修正模組12推算出第二車輛102的即時位置PB ,可根據兩位置PA 、PB 之補償距離,一併對第二車輛102提供的物體原始座標加入該補償距離。在車輛原始座標、物體原始座標都經過時間補償後,即分別得到一車輛座標及一物體座標,提供給該位置優化模組13進行後續處理。When the delay correction module 12 estimates the instantaneous position P B of the second vehicle 102, the compensation distance can be added to the original coordinate of the object provided by the second vehicle 102 according to the compensation distance of the two positions P A , P B . After the vehicle's original coordinates and the original coordinates of the object are time-compensated, a vehicle coordinate and an object coordinate are respectively obtained and provided to the position optimization module 13 for subsequent processing.

在步驟S30:該位置優化模組13接收到經時間補償後之鄰車的車輛座標及物體座標,並接收本車的車輛座標及本車的感測器測得之物體座標,並執行一優化程序如圖5所示,該優化程序包含有以下流程S31~S33:In step S30, the position optimization module 13 receives the vehicle coordinates and object coordinates of the time-compensated neighboring vehicle, and receives the vehicle coordinates of the vehicle and the object coordinates measured by the sensor of the vehicle, and performs an optimization. The program is shown in Figure 5. The optimization program includes the following processes S31~S33:

S31:比較定位精準度,係比較本車的車輛座標與鄰車的車輛座標,判斷何者的精準度較高。舉例而言,若本車的車輛座標是利用一即時動態測量(RTK)裝置所得到的座標,而鄰車的車輛座標是利用一般GPS接收器接收,則可判斷RTK提供的座標具有較高精準度;又例如本車與鄰車皆是利用相同等級的GPS接收器提供座標,則可根據兩GPS信號中的信任度來判斷何者精準度較高,例如根據GPS信號中包含的GGA訊息判斷兩GPS信號何者的信任度較高。S31: Compare the positioning accuracy. Compare the vehicle coordinates of the vehicle with the vehicle coordinates of the adjacent car to determine which one has higher accuracy. For example, if the vehicle coordinates of the vehicle are coordinates obtained by using a real-time dynamic measurement (RTK) device, and the vehicle coordinates of the adjacent vehicle are received by a general GPS receiver, the coordinate provided by the RTK can be judged to have high precision. For example, if the vehicle and the neighboring car use the same level of GPS receiver to provide coordinates, the reliability of the two GPS signals can be used to determine which one has higher accuracy, for example, according to the GGA message included in the GPS signal. The reliability of the GPS signal is higher.

S32:車輛定位優化,在判斷出本車與鄰車兩者的車輛座標何者精準度較高後,將先針對精準度較高者進行優化運算,其次再對精準度較低者進行優化運算。無論是針對本車或鄰車的位置資訊進行優化運算,其作法是: a) 根據本車與鄰車的車輛座標計算出複數個參考位置; b) 根據各參考位置之權重值,計算出一車輛優化座標。S32: Optimization of vehicle positioning. After determining which vehicle coordinates of the vehicle and the adjacent car are higher in accuracy, the operator will be optimized for the higher accuracy, and then the operator with lower accuracy will be optimized. Whether it is optimized for the position information of the vehicle or the neighboring car, the method is: a) calculating a plurality of reference positions according to the vehicle coordinates of the vehicle and the adjacent car; b) calculating a weight according to the weight values of the reference positions Vehicle optimization coordinates.

在本實施例中,係假設本車與鄰車皆配備有GPS接收器及其它感測器,並根據四個參考位置計算出車輛優化座標,且當判斷本車H的車輛座標與鄰車的車輛座標後,得知本車H的車輛座標具有較高的精準度,故以本車H為中心,優先對本車的車輛座標進行優化,其步驟詳述如後。首先,請參考圖6A所示,本車及鄰車分別以H、R表示,兩車可根據自身之GPS接收器得知自己的車輛座標,其中,本車H根據GPS接收器得知的車輛座標作為第一參考位置H1,該第一參考位置H1與本車H的實際位置有差異是因為GPS接收器之誤差量導致,鄰車R之GPS接收器感測出的車輛座標作為一基準位置R1。In this embodiment, it is assumed that the vehicle and the adjacent car are equipped with a GPS receiver and other sensors, and the vehicle optimized coordinates are calculated according to the four reference positions, and when the vehicle coordinates of the vehicle H and the neighboring vehicles are judged After the coordinates of the vehicle, it is known that the vehicle coordinates of the vehicle H have a high degree of precision. Therefore, with the vehicle H as the center, the vehicle coordinates of the vehicle are optimized first, and the steps are as follows. First, please refer to FIG. 6A, the vehicle and the adjacent car are respectively represented by H and R, and the two vehicles can know their own vehicle coordinates according to their own GPS receivers, wherein the vehicle H is known according to the GPS receiver. The coordinate is used as the first reference position H1, and the difference between the first reference position H1 and the actual position of the vehicle H is caused by the error amount of the GPS receiver, and the GPS receiver sensed by the GPS receiver of the neighboring vehicle R serves as a reference position. R1.

請參考圖6B所示,鄰車R的感測器因為可感知本車H的存在,因此可得知鄰車R與本車H與之間的相對距離D1與相對角度θ1,即得知本車H的相對座標。鄰車R即以自已的基準位置R1為參考基準,根據距離D1及角度θ1將本車H的相對座標轉換為一經緯度座標,該經緯度座標即作為第二參考位置H2。由鄰車R發出的資料封包,即包含有該第二參考位置H2的經緯度座標。Referring to FIG. 6B, the sensor of the neighboring vehicle R can know the existence of the vehicle H, so that the relative distance D1 between the neighboring vehicle R and the vehicle H and the relative angle θ1 can be known. The relative coordinates of the car H. The neighboring vehicle R converts the relative coordinates of the vehicle H into a latitude and longitude coordinate according to the distance D1 and the angle θ1 with the reference position R1 of the own vehicle as the reference reference, and the latitude and longitude coordinates serve as the second reference position H2. The data packet sent by the neighboring vehicle R, that is, the latitude and longitude coordinates of the second reference position H2.

請參考圖6C所示,本車H的感測器因為可感知鄰車R的存在,因此可得知本車H與鄰車R與之間的相對距離D2與相對角度θ2。本車H取得與鄰車R之間的相對距離D2及相對角度θ2之後,以鄰車R的基準位置R1作為參考基準反推出本車H的經緯度座標,可得到一第三參考位置H3。Referring to FIG. 6C, the sensor of the vehicle H can know the relative distance D2 between the vehicle H and the neighboring vehicle R and the relative angle θ2 because the presence of the neighboring vehicle R can be perceived. After the vehicle H obtains the relative distance D2 and the relative angle θ2 from the neighboring vehicle R, the latitude and longitude coordinates of the vehicle H are reversely derived using the reference position R1 of the neighboring vehicle R as a reference reference, and a third reference position H3 is obtained.

請參考圖6D所示,鄰車R與本車H之間以無線信號傳輸資料封包,因此,可根據無線信號收、發之間的強度衰減程度,推估兩車之間的相對距離D3,例如鄰車R發射出的無線信號功率預設為-10dBi,而本車H接收到的無線信號功率己成為-30dBi,即顯示兩車之間的距離讓無線訊號衰減了20dBi,因為衰減幅度與距離成正比且可預先建立一衰減關係表,因此根據該20dBi的衰減量可推測或查表得知兩車之間的相對距離D3。另一方面,因為本車H與鄰車R利用GPS接收器測知的車輛座標為已知,即第一參考位置H1及基準位置R1均為已知,可根據兩位置之間的一直向延伸線推測出本車H相對於鄰車R的所在方向。因此,以鄰車R的基準位置R1為基準,根據相對距離D3及方向算出一第四參考位置H4。Referring to FIG. 6D, the adjacent vehicle R and the vehicle H transmit data packets by wireless signals. Therefore, the relative distance D3 between the two vehicles can be estimated according to the intensity attenuation between the wireless signals. For example, the wireless signal power emitted by the neighboring vehicle R is preset to -10 dBi, and the wireless signal power received by the vehicle H has become -30 dBi, that is, the distance between the two vehicles is shown to attenuate the wireless signal by 20 dBi because of the attenuation amplitude and The distance is proportional to and a decay relationship table can be established in advance, so that the relative distance D3 between the two vehicles can be estimated or looked up based on the attenuation amount of the 20dBi. On the other hand, since the vehicle coordinates detected by the host vehicle H and the neighboring vehicle R using the GPS receiver are known, that is, the first reference position H1 and the reference position R1 are known, and can be extended according to the direction between the two positions. The line infers the direction of the vehicle H relative to the neighboring car R. Therefore, based on the reference position R1 of the neighboring vehicle R, a fourth reference position H4 is calculated based on the relative distance D3 and the direction.

請參考圖7,當取得第一參考位置H1~第四參考位置H4後,以各參考位置H1~H4為圓心相當於可決定出第一涵蓋範圍M1~第四涵蓋範圍M4,每個涵蓋範圍的大小係根據其參考位置之來源感測器的精準度而定,假設本車H的GPS接收器具有最好的精準度,則第一參考位置H1的涵蓋範圍最小,且精準度越高者,該參考位置也會具有一較高的權重值ω,其中GPS接收器會提供其本身的精準度。若其它感測器無法提供自身精準度,可根據該感測器推知後的位置其所在距離而決定其權重值,距離越遠,其權重越低。而本創作即是在第一涵蓋範圍M1~第四涵蓋範圍M4之交集區域(如斜線區域表示)計算出一車輛優化座標H(x,y)。Referring to FIG. 7, after the first reference position H1 to the fourth reference position H4 are obtained, the first coverage range M1 to the fourth coverage range M4 may be determined by using the reference positions H1 to H4 as the center, each coverage area. The size of the sensor is based on the accuracy of the source sensor of the reference position. If the GPS receiver of the vehicle H has the best accuracy, the first reference position H1 has the smallest coverage and the higher accuracy. The reference position will also have a higher weight value ω, where the GPS receiver will provide its own accuracy. If other sensors are unable to provide their own accuracy, the weight value may be determined according to the distance of the position after the sensor is inferred. The farther the distance is, the lower the weight is. The present invention calculates a vehicle optimization coordinate H(x, y) in the intersection area of the first coverage range M1 to the fourth coverage area M4 (as indicated by the oblique line area).

在步驟b)中,係根據各參考位置之權重值ω,計算出一車輛優化座標H(x,y),計算方式可表示如下:In step b), a vehicle optimization coordinate H(x, y) is calculated according to the weight value ω of each reference position, and the calculation manner can be expressed as follows:

,其中, ,among them,

在上式中,有m表示參考位置的數目,故本實施例m=4;(xi , yi )分別表示第一~第四參考位置H1~H4的座標;權重值ωi 的其中一種計算方式可採用Adaboost演算法或其它演算法。In the above formula, m denotes the number of reference positions, so m=4 in the present embodiment; (x i , y i ) denote coordinates of the first to fourth reference positions H1 to H4, respectively; one of the weight values ω i The calculation method can adopt Adaboost algorithm or other algorithms.

除了Adaboost演算法,在此提供一種權重值的計算方式。首先,假設第一參考位置H1~第四參考位置H4的誤差值分別為3、6、4、5公尺,可利用一誤差反比演算法計算四個不同的權重值,計算方式如下: 計算總誤差量,分別計算總誤差量與各誤差值的差異量,計算差異量的總量,四個權重值分別為: 本車H的車輛優化座標, 其中(xi , yi )分別表示四個參考位置的座標; H(x,y)代表車輛優化座標。In addition to the Adaboost algorithm, a way to calculate the weight value is provided here. First, assuming that the error values of the first reference position H1 to the fourth reference position H4 are 3, 6, 4, and 5 meters, respectively, an error inverse ratio algorithm can be used to calculate four different weight values, and the calculation manner is as follows: Amount of error, Calculate the difference between the total error amount and each error value separately. Calculate the total amount of difference, The four weight values are: Vehicle optimization coordinates of the vehicle H , where (x i , y i ) represent the coordinates of the four reference positions, respectively; H(x, y) represents the vehicle optimized coordinates.

當完成本車H的車輛座標的優化運算之後,其次再以鄰車R為中心,對鄰車R的車輛座標進行優化運算,其運算過程如同上述,只是互換本車與鄰車之間的角色,換言之,將鄰車資料視為是上述運算中的本車資料,並將本車資料視為是上述運算中的鄰車資料。因此,同樣可以得到代表鄰車之車輛優化座標R(x,y)。After the optimization of the vehicle coordinates of the vehicle H is completed, the vehicle coordinates of the neighboring vehicle R are optimized based on the neighboring vehicle R. The calculation process is the same as above, but the role between the vehicle and the adjacent vehicle is exchanged. In other words, the adjacent car data is regarded as the vehicle data in the above calculation, and the vehicle data is regarded as the adjacent car data in the above calculation. Therefore, the vehicle optimized coordinates R(x, y) representing the neighboring cars can also be obtained.

S33:物體定位優化,即針對鄰車R、本車H之感測器所測得的物體座標皆進行優化。在本車H部分,因為已得知本車H優化後之車輛優化座標H(x,y),故根據本車H感測器所測得的物體座標,可以比較本車H的原始車輛座標及其車輛優化座標H(x,y)之間的差異量,於計算本車H感測器測得之物體的物體優化座標時,即根據該差異量對本車H感測器測得之差異量進行補償,而得到一物體優化座標,完成對本車H測得之物體座標的優化運算。同理,在鄰車R部分,因為已得知鄰車R優化後之車輛優化座標,故根據鄰車R感測器所測得的物體座標,可以比較鄰車R的原始車輛座標及其車輛優化座標之間的差異量,在重新計算該對鄰車R感測器測得之物體的物體優化座標時,即根據該差異量對鄰車R感測器測得之差異量進行補償,而得到一物體優化座標。S33: Object positioning optimization, that is, the object coordinates measured by the sensor of the neighboring vehicle R and the vehicle H are optimized. In the H part of the car, since the vehicle optimized coordinate H(x, y) after the vehicle H optimization has been known, the original vehicle coordinates of the vehicle H can be compared according to the object coordinates measured by the vehicle H sensor. And the difference between the vehicle's optimized coordinates H(x, y), when calculating the object optimization coordinate of the object measured by the vehicle H sensor, that is, the difference measured by the vehicle H sensor according to the difference amount The quantity is compensated, and an object optimization coordinate is obtained to complete the optimization operation of the object coordinates measured by the vehicle H. In the same way, in the R part of the neighboring car, since the optimized coordinates of the vehicle after the optimization of the neighboring vehicle R have been known, the original vehicle coordinates of the neighboring vehicle R and its vehicles can be compared according to the coordinates of the object measured by the neighboring vehicle R sensor. Optimizing the amount of difference between the coordinates, and recalculating the object optimization coordinates of the object measured by the neighboring vehicle R sensor, that is, compensating the difference measured by the neighboring vehicle R sensor according to the difference amount, and Get an object optimization coordinate.

在步驟S40,本創作可利用該定位比對模組14融合來自不同鄰車R的多筆座標。舉例來說,請參考圖8所示,對第一車輛101而言,其它任一車輛102~104均會感測到周圍的物體並分享給第一車輛101,第一車輛101會接收到多筆關於同一物體(例如第二車輛102)的座標並暫存在一緩衝器(buffer)內,因此,第一車輛101內的定位比對模組14會從緩衝器內取出相似物體的座標,並加以融合成單一個位置資料,不同的物體座標則單獨新增。其中一種融合方式是透過K-Means分群演算法將多筆座標計算出一平均值,將同一車輛的車輛優化座標平均計算出一車輛代表座標,將同一物體的物體優化座標平均計算出一物體代表座標。In step S40, the author can use the positioning comparison module 14 to fuse multiple coordinates from different neighboring cars R. For example, referring to FIG. 8, for the first vehicle 101, any other vehicle 102-104 will sense surrounding objects and share it with the first vehicle 101, and the first vehicle 101 will receive more. The coordinates of the pen about the same object (for example, the second vehicle 102) are temporarily stored in a buffer, so that the positioning comparison module 14 in the first vehicle 101 takes the coordinates of the similar object from the buffer, and They are combined into a single location data, and different object coordinates are added separately. One of the fusion methods is to calculate the average value of multiple coordinates by K-Means grouping algorithm, calculate the vehicle representative coordinates of the same vehicle on average, and calculate the object representative coordinates of the same object on average. coordinate.

綜上所述,本創作車輛協同式物體定位優化方法係具備有下述優點:In summary, the collaborative vehicle object positioning optimization method of the present invention has the following advantages:

1. 利用本車與鄰車之間交換各自感測出的資料,可擴增各車輛的感測範圍,取得更多的環境資料。1. Using the information exchanged between the vehicle and the neighboring car, the sensing range of each vehicle can be amplified to obtain more environmental information.

2. 透過協同定位裝置重新校正車輛及周圍物體的座標資料,相較於單獨參考GPS接收器測知的座標資料,本創作可以得到更精準的座標,無論是應用於自動駕駛系統,或是用於提前警示駕駛者周圍環境之現況,均可提升行車安全性。2. By re-correcting the coordinate data of the vehicle and surrounding objects through the co-location device, the creation can obtain more precise coordinates compared to the coordinate data measured by the GPS receiver alone, whether it is applied to the automatic driving system or Driving safety can be improved by warning the driver of the surrounding environment in advance.

3. 利用本創作的協同定位方法,當本車完成優化運算後,可以得到優化完成後之本車定位資料、鄰車定位資料和一或多個物體定位資料,這三份資料會以BSM資料封包的格式傳送給周圍的鄰車,這時候的鄰車接收到BSM資料封包時,亦可以單獨執行本發明之優化運算,因此,周圍各車可分散運算,隨著時間的逐漸累積,車輛彼此之間的定位資料亦會漸漸提高精準度。3. Using the collaborative positioning method of this creation, after the vehicle completes the optimization calculation, the vehicle positioning data, the adjacent vehicle positioning data and one or more object positioning data after optimization can be obtained, and the three materials will be BSM data. The format of the packet is transmitted to the surrounding neighboring car. When the neighboring car receives the BSM data packet, the optimization operation of the present invention can also be performed separately. Therefore, the surrounding vehicles can be distributed and calculated, and the vehicles accumulate with each other over time. The positioning data between them will gradually improve the accuracy.

10‧‧‧車輛協同定位裝置
11‧‧‧無線傳輸介面
12‧‧‧延遲修正模組
13‧‧‧位置優化模組
14‧‧‧定位比對模組
15‧‧‧車身感知器
21‧‧‧第一部分
22‧‧‧第二部分
101‧‧‧第一車輛
102‧‧‧第二車輛
103‧‧‧第三車輛
104‧‧‧第四車輛
200‧‧‧物體
A1‧‧‧GPS誤差範圍
A2‧‧‧攝影機誤差範圍
A3‧‧‧GPS及攝影機累加誤差範圍
H‧‧‧本車
R‧‧‧鄰車
H1~H4‧‧‧第一參考位置~第四參考位置
R1‧‧‧基準位置
M1~M4‧‧‧第一涵蓋範圍~第四涵蓋範圍
10‧‧‧Vehicle co-location device
11‧‧‧Wireless transmission interface
12‧‧‧Delay correction module
13‧‧‧Location Optimization Module
14‧‧‧ Positioning comparison module
15‧‧‧Body Sensor
21‧‧‧Part 1
22‧‧‧Part II
101‧‧‧First vehicle
102‧‧‧Second vehicle
103‧‧‧ Third vehicle
104‧‧‧fourth vehicle
200‧‧‧ objects
A1‧‧‧GPS error range
A2‧‧‧ camera error range
A3‧‧‧GPS and camera accumulator error range
H‧‧‧Car
R‧‧‧ neighboring car
H1~H4‧‧‧first reference position to fourth reference position
R1‧‧‧ reference position
M1~M4‧‧‧First Coverage~Fourth Coverage

圖1:本創作協同定位裝置的架構方塊圖。 圖2:本創作車輛協同式物體定位優化方法的流程圖。 圖3:本創作BSM資料封包格式示意圖。 圖4:本創作對車輛原始位置執行時間延遲補償的示意圖。 圖5:本創作位置優化模組所執行之優化程序流程圖。 圖6A:本創作取得第一參考位置H1的示意圖。 圖6B:本創作取得第一參考位置H2的示意圖。 圖6C:本創作取得第一參考位置H3的示意圖。 圖6D:本創作取得第一參考位置H4的示意圖。 圖7:本創作利用多個參考位置計算車輛優化座標之示意圖。 圖8:本創作中多台車輛之資訊分享示意圖。 圖9:車輛行經交叉路口之示意圖。 圖10:協定式定位之誤差累積示意圖。Figure 1: Architecture block diagram of the authoring co-location device. Figure 2: Flow chart of the collaborative vehicle positioning optimization method for the author vehicle. Figure 3: Schematic diagram of the BSM data packet format of this creation. Figure 4: Schematic diagram of the implementation of time delay compensation for the original position of the vehicle. Figure 5: Flow chart of the optimization program executed by the creative location optimization module. FIG. 6A is a schematic diagram of the first reference position H1 obtained by the present creation. FIG. 6B is a schematic diagram of the first reference position H2 obtained by the present creation. FIG. 6C is a schematic diagram of the first reference position H3 obtained by the present creation. FIG. 6D is a schematic diagram of the first reference position H4 obtained by the present creation. Figure 7: This creation uses a plurality of reference locations to calculate a schematic diagram of the vehicle's optimized coordinates. Figure 8: Schematic diagram of information sharing for multiple vehicles in this creation. Figure 9: Schematic diagram of a vehicle passing through an intersection. Figure 10: Schematic diagram of the cumulative error of the contracted positioning.

H‧‧‧本車 H‧‧‧Car

H1~H4‧‧‧第一參考位置~第四參考位置 H1~H4‧‧‧first reference position~fourth reference position

M1~M4‧‧‧第一涵蓋範圍~第四涵蓋範圍 M1~M4‧‧‧First Coverage~Fourth Coverage

Claims (10)

一種車輛協同式物體定位優化方法,係利用一設置在本車內部之協同定位裝置執行,該方法包含有: 由本車接收一資訊封包,該資訊封包中包含一鄰車提供的車輛原始座標及至少一物體原始座標,該車輛原始座標及該物體原始座標分別具有各自之定位精準度; 對該車輛原始座標及物體原始座標進行時間延遲補償,以分別得到鄰車補償後的一車輛座標及一物體座標; 執行一優化程序,其包含: 比對本車的車輛座標與鄰車的車輛座標,判斷何者具有較高的定位精準度; 優先對具有較高定位精準度的車輛座標進行一優化運算,再對具有較低定位精準度的車輛座標進行優化運算,其中,該優化運算執行: a) 根據本車的車輛座標與鄰車的車輛座標計算出複數個參考位置;及 b) 根據各參考位置之權重值,計算出一車輛優化座標; 對物體座標進行優化,係比較鄰車的原始車輛座標及其車輛優化座標之間的差異量,依據該差異量對鄰車提供之物體座標進行補償以得到一物體優化座標;並比較本車的原始車輛座標及本車的車輛優化座標之間的差異量,依該差異量對本車提供之物體座標進行補償以得到一物體優化座標。A vehicle coordinated object positioning optimization method is implemented by using a co-location device disposed inside the vehicle, the method comprising: receiving, by the vehicle, an information packet, where the information packet includes an original coordinate of the vehicle provided by the neighboring vehicle and at least The original coordinate of an object, the original coordinates of the vehicle and the original coordinates of the object respectively have their own positioning accuracy; time delay compensation is performed on the original coordinates of the vehicle and the original coordinates of the object to obtain a vehicle coordinate and an object compensated by the adjacent vehicle respectively. Coordinates; perform an optimization procedure, which includes: comparing the vehicle coordinates of the vehicle with the vehicle coordinates of the adjacent vehicle to determine which has higher positioning accuracy; preferentially performing an optimization operation on the vehicle coordinates with higher positioning accuracy, and then Optimizing the operation of the vehicle coordinates with lower positioning accuracy, wherein the optimization operation is performed: a) calculating a plurality of reference positions according to the vehicle coordinates of the vehicle and the vehicle coordinates of the adjacent vehicle; and b) according to each reference position Weight value, calculate a vehicle optimization coordinate; optimize the object coordinates, Comparing the difference between the original vehicle coordinates of the adjacent car and the optimized coordinates of the vehicle, the object coordinates provided by the adjacent car are compensated according to the difference amount to obtain an object optimization coordinate; and the original vehicle coordinates of the vehicle and the vehicle are compared The amount of difference between the coordinates of the vehicle is optimized, and the object coordinates provided by the vehicle are compensated according to the difference amount to obtain an object optimization coordinate. 如請求項1所述之車輛協同式物體定位優化方法,在執行優化程序之後,進一步包含: 一座標比對融合步驟,比對不同鄰車執行優化程序之後所得到的多筆車輛優化座標、多筆物體優化座標,將同一車輛的車輛優化座標平均計算出一車輛代表座標,將同一物體的物體優化座標平均計算出一物體代表座標。The vehicle coordinated object positioning optimization method according to claim 1, after performing the optimization program, further comprises: a target pair fusion step, comparing the plurality of vehicle optimization coordinates obtained after performing the optimization program on different neighboring cars, The pen object optimizes coordinates, calculates a vehicle representative coordinate on average for the vehicle optimization coordinates of the same vehicle, and calculates an object representative coordinate on average for the object optimization coordinates of the same object. 如請求項1或2所述之車輛協同式物體定位優化方法,其中,本車的車輛座標及鄰車的車輛原始座標,係分別由設置在本車及鄰車的GPS接收器輸出。The vehicle coordinated object positioning optimization method according to claim 1 or 2, wherein the vehicle coordinates of the vehicle and the original coordinates of the vehicle of the adjacent vehicle are respectively output by a GPS receiver disposed in the vehicle and the adjacent vehicle. 如請求項3所述之車輛協同式物體定位優化方法,其中,在比對本車的車輛座標與鄰車的車輛座標,判斷何者具有較高的定位精準度之步驟中,係比對本車及鄰車的GPS接收器的定位精準度。The vehicle coordinated object positioning optimization method according to claim 3, wherein in comparing the vehicle coordinates of the vehicle with the vehicle coordinates of the adjacent vehicle, in the step of determining which has higher positioning accuracy, comparing the vehicle and the neighbor The positioning accuracy of the car's GPS receiver. 如請求項4所述之車輛協同式物體定位優化方法,其中,在進行時間延遲補償之步驟中,係根據該資訊封包其一發出時間及一接收時間之間的時間延遲量,計算鄰車在該時間延遲量內所移動的一補償距離,以鄰車的該車輛原始座標加上該補償距離而得到該車輛座標。The vehicle coordinated object positioning optimization method according to claim 4, wherein, in the step of performing time delay compensation, the neighboring vehicle is calculated according to the time delay between the sending time and the receiving time of the information packet. A compensation distance moved within the time delay amount is obtained by adding the compensation distance to the original coordinate of the vehicle of the adjacent vehicle. 如請求項5所述之車輛協同式物體定位優化方法,其中,鄰車以其GPS接收器輸出之車輛原始座標作為一基準位置,該複數個參考位置包含: 一第一參考位置,係本車以本身之GPS接收器輸出之車輛座標; 一第二參考位置,係鄰車以本身之一感測器感知本車的一相對座標,再以該基準位置作為一基準點,將該相對座標反算得知本車之經緯度,獲得該第二參考位置; 一第三參考位置,係本車利用自身之一感測器感知鄰車的相對距離及角度,再以該基準位置作為基準點,將該相對距離及角度反算得知本車之經緯度,獲得該第三參考位置; 一第四參考位置,係根據該資料封包從鄰車發出至本車接收後之衰減程度,估算本車與鄰車之相對距離,並根據第一參考位置及基準位置之一直向延伸線,得知本車相對於鄰車的所在方向,根據該相對距離及該所在方向反算得知本車之經緯度,獲得該第四參考位置。The vehicle coordinated object positioning optimization method according to claim 5, wherein the adjacent vehicle uses the original coordinate of the vehicle output by the GPS receiver as a reference position, and the plurality of reference positions include: a first reference position, which is the vehicle a vehicle coordinate output by the GPS receiver; a second reference position, the neighboring vehicle senses a relative coordinate of the vehicle by one of the sensors, and then uses the reference position as a reference point to reverse the relative coordinate Calculating the latitude and longitude of the vehicle, obtaining the second reference position; a third reference position, the vehicle uses one of its own sensors to sense the relative distance and angle of the adjacent car, and then using the reference position as a reference point, The relative distance and angle are inversely calculated to know the latitude and longitude of the vehicle, and the third reference position is obtained; a fourth reference position is estimated based on the attenuation degree of the data packet from the neighboring vehicle to the vehicle after receiving the vehicle, and estimating the vehicle and the neighboring vehicle. Relative distance, and according to the straight line of the first reference position and the reference position, the direction of the vehicle relative to the adjacent car is obtained, according to the relative distance and the direction of the opposite direction That the latitude and longitude of the vehicle, obtains the fourth reference position. 如請求項6所述之車輛協同式物體定位優化方法,其中,該車輛優化座標係由下式計算:,其中,,m代表參考位置的數量,(xi , yi )分別表示第一~第四參考位置的座標,各參考位置的權重值為ωiThe vehicle coordinated object positioning optimization method according to claim 6, wherein the vehicle optimized coordinate system is calculated by: ,among them, m represents the number of reference positions, and (x i , y i ) denote coordinates of the first to fourth reference positions, respectively, and the weight value of each reference position is ω i . 如請求項7所述之車輛協同式物體定位優化方法,其中,該資料封包為一基本安全訊息(BSM)封包。The vehicle coordinated object positioning optimization method according to claim 7, wherein the data packet is a basic security message (BSM) packet. 如請求項7所述之車輛協同式物體定位優化方法,其中,各參考位置的權重值,係根據產生各參考位置時所利用之感測器的精準度而訂。The vehicle coordinated object positioning optimization method according to claim 7, wherein the weight value of each reference position is set according to the accuracy of the sensor used when generating each reference position. 一種車輛協同定位裝置,包含有: 一無線傳輸介面,係接收一資料封包,該資訊封包中包含鄰車的一車輛原始座標及至少一物體原始座標以及該車輛原始座標與物體原始座標各自之定位精準度; 一延遲修正模組,係透過無線傳輸介面接收鄰車發送出來的資料封包,對該車輛原始座標及物體原始座標進行時間延遲補償,以得到時間延遲補償後的一車輛座標及一物體座標; 一位置優化模組,接收延遲修正模組提供之鄰車的該車輛座標及該物體座標,並接收本車的車輛座標及本車的感測器測得之物體座標,該位置優化模組執行一優化程序,該優化程序包含: 比對本車的車輛座標與鄰車的車輛座標,判斷何者具有較高的定位精準度; 優先對具有較高定位精準度的車輛座標進行一優化運算,再對具有較低定位精準度的車輛座標進行優化運算,其中,該優化運算執行: a) 根據本車的車輛座標與鄰車的車輛座標計算出複數個參考位置;及 b) 根據各參考位置之權重值,計算出一車輛優化座標; 對物體座標進行優化,係比較鄰車的原始車輛座標及其車輛優化座標之間的差異量,依據該差異量對鄰車提供之物體座標進行補償以得到一物體優化座標;並比較本車的原始車輛座標及本車的車輛優化座標之間的差異量,依該差異量對本車提供之物體座標進行補償以得到一物體優化座標。A vehicle co-location device includes: a wireless transmission interface, which receives a data packet, wherein the information packet includes a vehicle original coordinate of the adjacent vehicle and at least one original object coordinate, and a positioning of the original coordinate of the vehicle and the original coordinate of the object Accuracy; a delay correction module receives the data packet sent by the neighboring car through the wireless transmission interface, and compensates the original coordinate of the vehicle and the original coordinate of the object for time delay to obtain a vehicle coordinate and an object after time delay compensation. a coordinate optimization module, the vehicle coordinate and the object coordinate of the adjacent vehicle provided by the delay correction module, and receiving the vehicle coordinates of the vehicle and the object coordinates measured by the sensor of the vehicle, the position optimization mode The group executes an optimization program, which comprises: comparing the vehicle coordinates of the vehicle with the vehicle coordinates of the adjacent vehicle to determine which has higher positioning accuracy; preferentially performing an optimization operation on the vehicle coordinates with higher positioning accuracy, Optimize the coordinates of the vehicle with lower positioning accuracy, where the The calculation is performed: a) calculating a plurality of reference positions according to the vehicle coordinates of the vehicle and the coordinates of the vehicle of the adjacent vehicle; and b) calculating a vehicle optimized coordinate according to the weight value of each reference position; optimizing the coordinates of the object, comparing The difference between the original vehicle coordinates of the adjacent vehicle and the optimized coordinates of the vehicle, the object coordinates provided by the neighboring vehicle are compensated according to the difference amount to obtain an object optimization coordinate; and the original vehicle coordinates of the vehicle and the vehicle of the vehicle are compared The amount of difference between the coordinates is optimized, and the object coordinates provided by the vehicle are compensated according to the difference amount to obtain an object optimization coordinate.
TW104142232A 2015-12-16 2015-12-16 Optimization Method of Vehicle Coordinated Object Location and Vehicle Coordinate Location Device TWI584238B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW104142232A TWI584238B (en) 2015-12-16 2015-12-16 Optimization Method of Vehicle Coordinated Object Location and Vehicle Coordinate Location Device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW104142232A TWI584238B (en) 2015-12-16 2015-12-16 Optimization Method of Vehicle Coordinated Object Location and Vehicle Coordinate Location Device

Publications (2)

Publication Number Publication Date
TWI584238B TWI584238B (en) 2017-05-21
TW201724050A true TW201724050A (en) 2017-07-01

Family

ID=59367769

Family Applications (1)

Application Number Title Priority Date Filing Date
TW104142232A TWI584238B (en) 2015-12-16 2015-12-16 Optimization Method of Vehicle Coordinated Object Location and Vehicle Coordinate Location Device

Country Status (1)

Country Link
TW (1) TWI584238B (en)

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI469886B (en) * 2012-04-25 2015-01-21 Ind Tech Res Inst Cooperative event data record system and method
WO2014011556A1 (en) * 2012-07-09 2014-01-16 Elwha Llc Systems and methods for vehicle monitoring

Also Published As

Publication number Publication date
TWI584238B (en) 2017-05-21

Similar Documents

Publication Publication Date Title
CN106896393B (en) Vehicle cooperative type object positioning optimization method and vehicle cooperative positioning device
JP6219312B2 (en) Method for determining the position of a vehicle in a lane traffic path of a road lane and a method for detecting alignment and collision risk between two vehicles
KR101622028B1 (en) Apparatus and Method for controlling Vehicle using Vehicle Communication
US9162682B2 (en) Method and device for determining the speed and/or position of a vehicle
US11321950B2 (en) Apparatus and method for detecting lane information, and computer-readable recording medium storing computer program programmed to execute same method
US10466366B2 (en) Optimizing method for vehicle cooperative object positioning and vehicle cooperative positioning apparatus
US10282997B2 (en) System and method for generating and communicating lane information from a host vehicle to a vehicle-to-vehicle network
CN106485949A (en) The sensor fusion of the video camera for vehicle and V2V data
JP2018512658A (en) Real-time occupancy mapping system for autonomous vehicles
WO2020151663A1 (en) Vehicle positioning apparatus, system and method, and vehicle
JP2015133092A (en) Collision warning device for vehicle and collision warning method for vehicle
JP6330471B2 (en) Wireless positioning device
US9883354B2 (en) Method and system for localizing a vehicle and vehicle with a device for carrying out vehicle-to-X communications
KR101439019B1 (en) Car control apparatus and its car control apparatus and autonomic driving method
CN110962744A (en) Vehicle blind area detection method and vehicle blind area detection system
KR102528421B1 (en) Communications terminal for vehicle and method for positioning vehicle using the same
TW201930921A (en) Cooperative sensing
US20140316690A1 (en) Device and method for determining the position of a vehicle
US20200211393A1 (en) Vehicle and method of controlling the same
JP5251467B2 (en) Information providing apparatus and information providing method for vehicle
TWI584238B (en) Optimization Method of Vehicle Coordinated Object Location and Vehicle Coordinate Location Device
JP2014215092A (en) Vehicle location estimation system and vehicle location estimation device
US10186154B2 (en) Device and method for detecting surrounding vehicles
JP7326429B2 (en) How to select the sensor image interval
JP6287117B2 (en) Object detection system