TW201908765A - Real-time Precise Positioning System of Vehicle - Google Patents

Real-time Precise Positioning System of Vehicle

Info

Publication number
TW201908765A
TW201908765A TW106123893A TW106123893A TW201908765A TW 201908765 A TW201908765 A TW 201908765A TW 106123893 A TW106123893 A TW 106123893A TW 106123893 A TW106123893 A TW 106123893A TW 201908765 A TW201908765 A TW 201908765A
Authority
TW
Taiwan
Prior art keywords
vehicle
information
module
positioning
map
Prior art date
Application number
TW106123893A
Other languages
Chinese (zh)
Other versions
TWI635302B (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 TW106123893A priority Critical patent/TWI635302B/en
Application granted granted Critical
Publication of TWI635302B publication Critical patent/TWI635302B/en
Publication of TW201908765A publication Critical patent/TW201908765A/en

Links

Landscapes

  • Navigation (AREA)

Abstract

A real-time precise positioning system of vehicle, which provides a real-time precise positioning information for a vehicle, includes a cartographic material positioning module, a road vision sensing module, a vehicle-dynamic detective module, and a full-domain precisely operating module. The real-time precise positioning system of vehicle obtains a real-time high accuracy position of which the error is within a lane-level range by means of a data fusion regarding the cartographic material positioning information of the vehicle, the lane-vision information and the dynamic-state information executed by the full-domain precisely operating module.

Description

載具即時精準定位系統Vehicle accurate positioning system

本發明相關於一種定位系統,特別是一種相關於先進駕駛輔助系統(ADAS)的即時精準定位系統。The present invention relates to a positioning system, and more particularly to an instant precision positioning system related to an advanced driving assistance system (ADAS).

先進駕駛輔助系統(ADAS,Advanced Driver Assistance Systems)是近年所發展的智慧車輛技術,其收集並分析車外環境變化的資訊,以提供駕駛人判斷及因應。具體而言,先進駕駛輔助系統係透過視覺感測器及雷達偵測車輛周圍的環境資訊(相對定位資訊)以輔助駕駛。但是,先進駕駛輔助系統並無法偵知未來道路及環境的狀況(絕對定位資訊),如提供前方兩百公尺處交流道的安全速度,因而在先進駕駛輔助系統中形成潛藏的危險因子。Advanced Driver Assistance Systems (ADAS) is a smart vehicle technology developed in recent years that collects and analyzes information on changes in the environment outside the vehicle to provide driver judgment and response. Specifically, the advanced driver assistance system uses the visual sensors and radar to detect environmental information (relative positioning information) around the vehicle to assist driving. However, advanced driver assistance systems are not able to detect future road and environmental conditions (absolute positioning information), such as providing a safe speed of the two-hundred-meter front interchange, thus creating a hidden risk factor in advanced driver assistance systems.

當然,駕駛人可藉由導航機的安裝,以提供大範圍的道路資訊(絕對定位資訊)。詳細而言,導航機係接收衛星定位所即時回傳的經、緯度(有時也包括高度)資訊,並配合連接至資料庫的地圖,從而令駕駛人知悉目前交通載具所在地的位置以及鄰近區域的道路資訊。Of course, drivers can use the navigation machine to provide a wide range of road information (absolute positioning information). In detail, the navigation system receives the latitude, longitude (and sometimes height) information that is instantly returned by the satellite positioning, and cooperates with the map connected to the database, so that the driver knows the location and proximity of the current traffic vehicle. Road information for the area.

然而,現有的平價導航機係提供一般等級精度的載具定位,而無法呈現出較精密的定位與道路資訊。並且,由於導航機的更新頻率低(約為每一至三個月更新一次),使得的資料庫的地圖資訊無法即時因應真實環境的變化而有所誤差,從而影響導航機定位時所能呈現道路與定位資訊的品質。此外,為了提高道路與定位資訊的品質,一般會想到要更換導航機的晶片,但該晶片的更換成本高(高於原先安裝導航機的成本)且藉由更換晶片所能得到的導航機於定位精度及提供道路資訊的品質提升是有限的。因此,就導航機整體的性能及成本來評估,這樣的作法並無法得到足夠好的效果,實為得不償失。However, the existing parity navigation machine provides vehicle positioning with general grade accuracy, and cannot present more precise positioning and road information. Moreover, since the update frequency of the navigation machine is low (about once every three to three months), the map information of the database cannot be instantaneously affected by the change of the real environment, thereby affecting the way the navigation machine can be positioned. And the quality of the location information. In addition, in order to improve the quality of road and positioning information, it is generally thought to replace the wafer of the navigation machine, but the replacement cost of the wafer is high (higher than the cost of installing the navigation machine) and the navigation machine can be obtained by replacing the wafer. Positioning accuracy and quality improvement in providing road information are limited. Therefore, as far as the performance and cost of the navigation machine are concerned, it is not worth the loss.

因此,本發明的目的即在提供一種載具即時精準定位系統,即使在使用平價導航機(一般精度等級)的前提下,亦能得到低成本且高定位精度的圖資定位。Therefore, the object of the present invention is to provide an instant precise positioning system for a vehicle, which can obtain low-cost and high positioning accuracy map positioning even under the premise of using an inexpensive navigation machine (general accuracy level).

本發明為解決習知技術之問題所採用之技術手段係提供一種載具即時精準定位系統,係對於一載具予以提供即時精準定位資訊,該載具即時精準定位系統包含:一圖資定位模組,設有一全球定位系統及一高精度電子地圖,該全球定位系統取得的全球定位系統資訊,該高精度電子地圖具有高精度電子地圖資訊;一道路視覺感測模組,係經配置以取得該載具所在道路之道路視覺資訊;一載具運動偵測模組,係經配置以取得該載具的運動狀態資訊;以及一全域精準運算模組,訊號連接於該圖資定位模組、該道路視覺感測模組及該載具運動偵測模組,該全域精準運算模組將該全球定位系統資訊及高精度電子地圖資訊予以匹配而得出圖資定位資訊,且具有一交互式多模型子模組及一限制型無損式卡爾曼濾波器,以將由該圖資定位模組所傳送之該圖資定位資訊、由該道路視覺感測模組所傳送之該道路視覺資訊及由該載具運動偵測模組所傳送之該運動狀態資訊予以執行一資料融合處理以得出一即時且誤差範圍在一個車道內的高精度定位。The technical means adopted by the present invention to solve the problems of the prior art provides a real-time accurate positioning system for a vehicle, which provides instant and accurate positioning information for a vehicle. The vehicle accurate positioning system includes: a positioning positioning module The group has a global positioning system and a high-precision electronic map, the global positioning system information obtained by the global positioning system, the high-precision electronic map has high-precision electronic map information; a road visual sensing module is configured to obtain The road visual information of the road on which the vehicle is located; a vehicle motion detection module configured to obtain motion information of the vehicle; and a global precision computing module, the signal is connected to the image positioning module, The road visual sensing module and the vehicle motion detecting module, the global precision computing module matches the global positioning system information and the high-precision electronic map information to obtain the map positioning information, and has an interactive a multi-model sub-module and a limited-loss non-destructive Kalman filter for transmitting the map positioning information transmitted by the map positioning module The road visual information transmitted by the road visual sensing module and the motion state information transmitted by the vehicle motion detecting module perform a data fusion process to obtain an instant and the error range is within one lane. High precision positioning.

在本發明的一實施例中係提供一種載具即時精準定位系統,其中該道路視覺感測模組具有一影像感測器及一光達裝置,該影像感測器係經配置以偵測該載具所處位置為官方所設置的道路視覺資訊,該光達裝置係經配置以量測該載具與該道路視覺資訊間的距離並修正該道路視覺資訊的內容,該全域精準運算模組針對該圖資定位資訊、該道路視覺資訊進行資料融合處理以取得該圖資定位模組的一定位修正資訊。In an embodiment of the invention, a vehicle accurate sensing system is provided, wherein the road vision sensing module has an image sensor and a light device, and the image sensor is configured to detect the The vehicle is located at the officially set road visual information, and the optical device is configured to measure the distance between the vehicle and the road visual information and correct the content of the road visual information. The global precision computing module And performing data fusion processing on the map positioning information and the road visual information to obtain a positioning correction information of the map positioning module.

在本發明的一實施例中係提供一種載具即時精準定位系統,其中該全域精準運算模組設有一地圖匹配子模組,該地圖匹配子模組經配置將該全球定位系統資訊及高精度電子地圖資訊予以匹配而得出該圖資定位資訊,且將該圖資定位資訊、該道路視覺資訊及該運動狀態資訊進行匹配並傳送予該交互式多模型子模組進行該載具於縱向運動、橫向運動及斜向運動的運算。In an embodiment of the present invention, a real-time accurate positioning system for a vehicle is provided, wherein the global precision computing module is provided with a map matching sub-module configured to provide global positioning system information and high precision. The electronic map information is matched to obtain the map positioning information, and the map positioning information, the road visual information and the motion state information are matched and transmitted to the interactive multi-model sub-module to perform the vehicle in the vertical direction. Motion, lateral motion, and oblique motion calculations.

在本發明的一實施例中係提供一種載具即時精準定位系統,其中該載具運動偵測模組具有一慣性測量單元及一車輛動態感知器,該慣性測量單元係經配置以偵測該載具的俯仰、轉向、翻滾與轉向率,該車輛動態感知器係經配置以偵測該載具的車速與轉向角度,該交互式多模型子模組針對該載具運動偵測模組的運動狀態資訊、該圖資定位資訊及該地圖匹配子模組進行資料融合處理以取得該載具的定位修正資訊,該載具的定位修正資訊係作為該限制型無損式卡爾曼濾波器對於該圖資定位模組的一定位運算限制條件。In an embodiment of the invention, a carrier accurate positioning system is provided, wherein the vehicle motion detection module has an inertial measurement unit and a vehicle dynamic sensor, and the inertial measurement unit is configured to detect the The vehicle's pitch sensor, the steering, the roll, and the steering rate are configured to detect the vehicle speed and the steering angle of the vehicle. The interactive multi-model sub-module is for the vehicle motion detection module. The motion state information, the map positioning information, and the map matching sub-module perform data fusion processing to obtain positioning correction information of the vehicle, and the positioning correction information of the vehicle is used as the limited-type lossless Kalman filter. A positioning operation limitation condition of the image positioning module.

在本發明的一實施例中係提供一種載具即時精準定位系統,其中該限制型無損式卡爾曼濾波器經配置依據該地圖匹配子模組及該交互式多模型子模組進行資料融合,且形成一限制取樣點以修正該圖資定位模組的定位資訊。In an embodiment of the present invention, a carrier accurate positioning system is provided, wherein the limited-type lossless Kalman filter is configured to perform data fusion according to the map matching sub-module and the interactive multi-model sub-module. And forming a limit sampling point to correct the positioning information of the image positioning module.

經由本發明所採用的技術手段,載具即時精準定位系統透過一平價的全球定位系統及高精度電子地圖,以即時地獲得載具所在位置的經、緯度定位與一精度為車道線等級(Lane-Level)的高準確度的道路地圖。同時,載具即時精準定位系統藉由道路視覺感測模組偵測載具所處位置的官方設置的道路視覺資訊(如,道路交通標誌、標線及號誌),並以載具運動偵測模組偵測載具的運動狀態資訊(即,該載具的俯仰、轉向、翻滾、轉向率、車速與轉向角度)。並且,載具即時精準定位系統藉著全域精準運算模組針對圖資定位模組、道路視覺感測模組及載具運動偵測模組進行資料融合處理,以得到誤差範圍在一個車道內的高精度定位。Through the technical means adopted by the present invention, the vehicle real-time precise positioning system obtains the latitude and longitude positioning of the position of the vehicle and the accuracy of the lane line level through an inexpensive global positioning system and a high-precision electronic map (Lane -Level) Highly accurate road map. At the same time, the vehicle's real-time precision positioning system detects the officially set road visual information (such as road traffic signs, markings and signs) of the vehicle's location by means of the road visual sensing module, and uses the vehicle motion detection. The test module detects the motion state information of the vehicle (ie, the pitch, steering, roll, steering rate, vehicle speed and steering angle of the vehicle). Moreover, the vehicle accurate positioning system performs data fusion processing for the image positioning module, the road visual sensing module and the vehicle motion detecting module through the global precision computing module to obtain the error range in one lane. High precision positioning.

以下根據第1圖至第4圖,而說明本發明的實施方式。該說明並非為限制本發明的實施方式,而為本發明之實施例的一種。Hereinafter, embodiments of the present invention will be described based on Figs. 1 to 4 . This description is not intended to limit the embodiments of the invention, but is an embodiment of the invention.

請參照第1圖所示,本發明一實施例的載具即時精準定位系統100,係配置於一載具且對於該載具予以提供即時精準定位資訊。該載具即時精準定位系統包含一圖資定位模組1、一道路視覺感測模組2、一載具運動偵測模組3及一全域精準運算模組4。並且,本發明實施例的載具即時精準定位系統100適合應用於一先進駕駛輔助系統A(ADAS)的即時偵測系統,以即時判斷該載具所處道路的相對位置與絕對位置,提升即時偵測的可靠度。透過該全域精準運算模組4的資料融合(Data Fusion)處理,以給予該先進駕駛輔助系統A有關「高精度定位A1」、「載具動態行為A2」及「地圖資訊A3」的服務功能。從而使該先進駕駛輔助系統A的視覺感測器不致因天候、視線與道路狀況的影響,而對於道路邊線的偵測失效。Referring to FIG. 1 , a vehicle instant precise positioning system 100 according to an embodiment of the present invention is configured on a carrier and provides instant accurate positioning information for the vehicle. The vehicle accurate positioning system comprises a picture positioning module 1, a road visual sensing module 2, a vehicle motion detecting module 3 and a global precision computing module 4. Moreover, the vehicle instant precise positioning system 100 of the embodiment of the present invention is suitable for an instant detection system of an advanced driving assistance system A (ADAS) to instantly determine the relative position and absolute position of the road where the vehicle is located, and improve the instant. The reliability of detection. Through the data fusion (Data Fusion) processing of the global precision computing module 4, the advanced driving assistance system A provides the service functions of "high-precision positioning A1", "vehicle dynamic behavior A2" and "map information A3". Therefore, the visual sensor of the advanced driving assistance system A is not affected by the weather, the line of sight and the road condition, and the detection of the road edge is invalid.

請參照第1圖及第2圖所示,該圖資定位模組1具有一全球定位系統11及一高精度電子地圖12。具體而言,該全球定位系統(GPS, Global Positioning System)11為一導航機,只要足以提供一般等級精度的全球定位系統資訊(即時性的經、緯度定位資訊)即可。因此,在本發明中,該全球定位系統11特別是可選用一平價的商業用導航機,以降低整體系統的設置成本。其中,該高精度電子地圖12為一預先設置的高精準定位點的資料庫(誤差在2公分內),以提供高精度電子地圖資訊。該高精度電子地圖資訊包含路段的起、終點座標、車道寬、車道數、道路航向角度、道路曲率與路段長等路面資訊。並且,該高精度電子地圖12係經過國土測繪中心的RTK(Real-Time Kinematic,即時動態定位)修正後,經過座標轉換而投影在一絕對座標上。Referring to FIGS. 1 and 2 , the map positioning module 1 has a global positioning system 11 and a high-precision electronic map 12 . Specifically, the Global Positioning System (GPS) 11 is a navigation machine, as long as it is sufficient to provide global positioning system information (immediate latitude and longitude positioning information) of general level accuracy. Therefore, in the present invention, the global positioning system 11 can optionally use an inexpensive commercial navigation machine to reduce the installation cost of the overall system. The high-precision electronic map 12 is a pre-set high-precision positioning point database (with an error of 2 cm) to provide high-precision electronic map information. The high-precision electronic map information includes road information such as the starting and ending coordinates of the road section, the lane width, the number of lanes, the heading angle of the road, the curvature of the road, and the length of the road section. Moreover, the high-precision electronic map 12 is corrected by the RTK (Real-Time Kinematic) of the National Land Surveying Center, and is projected onto an absolute coordinate by coordinate conversion.

請參照第1圖所示,該道路視覺感測模組2具有一影像感測器21及一光達裝置22。該道路視覺感測模組2係經配置以取得該載具所在道路之道路視覺資訊。具體而言,該影像感測器21可為CCD(Charge Couple Device,感光耦合元件)影像感測器,且經配置以偵測該載具所處位置為官方所設置的道路視覺資訊。所述官方所設置的道路視覺資訊即道路交通標誌、標線或號誌。進一步而言,該影像感測器21係用以偵測、辨識該載具所在位置的車道線(用於載具的側向修正)、停止線、道路號誌(用於載具的縱向修正)。該光達(LiDAR, Light Detection And Ranging)裝置22係以雷射光對目標物進行量測的裝置。於本發明的實施例,該光達裝置22經配置以量測該載具與該道路視覺資訊間的距離,以輔助修正因光照影響形成該影像感測器21對於該道路視覺資訊的偵測誤差。換言之,該光達裝置22能在不受光照的影響之下量測該載具與環境間的距離,藉此進行該載具於側向及縱向上的位置誤差。Referring to FIG. 1 , the road visual sensing module 2 has an image sensor 21 and a light reaching device 22 . The road visual sensing module 2 is configured to obtain road visual information of the road on which the vehicle is located. Specifically, the image sensor 21 can be a CCD (Charge Couple Device) image sensor, and is configured to detect that the position of the vehicle is officially set road visual information. The road visual information set by the official is a road traffic sign, a marking line or a sign. Further, the image sensor 21 is used for detecting and recognizing a lane line of the vehicle (for lateral correction of the vehicle), a stop line, and a road number (for longitudinal correction of the vehicle) ). The LiDAR (Light Detection And Ranging) device 22 is a device that measures a target with laser light. In the embodiment of the present invention, the optical device 22 is configured to measure the distance between the vehicle and the visual information of the road to assist in correcting the detection of the visual information of the road by the image sensor 21 due to the influence of illumination. error. In other words, the light reaching device 22 can measure the distance between the carrier and the environment without being affected by the illumination, thereby performing positional errors in the lateral and longitudinal directions of the carrier.

請參照第1圖所示,該載具運動偵測模組3係經配置以取得該載具的運動狀態資訊,且具有一慣性測量單元31及一車輛動態感知器32。詳細而言,該慣性測量單元(IMU, Inertial Measurement Unit)31係一測量物體三軸姿態角(或角速率)及加速度的裝置,於本發明的實施例,該慣性測量單元31經配置以偵測該載具於運動狀態下的俯仰(Pitch)、轉向(Yaw)、翻滾(Roll)與轉向率(Yaw Rate)。於本發明的實施例,該車輛動態感知器32係經配置以偵測該載具的輪速與轉向角度。具體而言,該車輛動態感知器32係以旋轉角度編碼器量測該載具的輪速,同時以角度感知器偵測該載具的轉向角度(即,載具的偏航角度)。Referring to FIG. 1 , the vehicle motion detection module 3 is configured to obtain motion state information of the vehicle, and has an inertial measurement unit 31 and a vehicle motion sensor 32 . In detail, the Inertial Measurement Unit (IMU) 31 is a device for measuring an object's triaxial attitude angle (or angular rate) and acceleration. In the embodiment of the present invention, the inertial measurement unit 31 is configured to detect The pitch, the Yaw, the Roll, and the Yaw Rate of the vehicle under motion are measured. In an embodiment of the invention, the vehicle dynamics sensor 32 is configured to detect the wheel speed and steering angle of the vehicle. Specifically, the vehicle dynamics sensor 32 measures the wheel speed of the vehicle with a rotational angle encoder while detecting the steering angle of the vehicle (ie, the yaw angle of the vehicle) with an angle sensor.

請參照第1圖至第2圖所示,該全域精準運算模組4具有一地圖匹配子模組41、一交互式多模型子模組42及一限制型無損式卡爾曼濾波器43。該全域精準運算模組4訊號連接於該圖資定位模組1、該道路視覺感測模組2及該載具運動偵測模組3,以將由該圖資定位模組1所傳送之該圖資定位資訊、由該道路視覺感測模組2所傳送之該道路視覺資訊及由該載具運動偵測模組3所傳送之該運動狀態資訊予以執行一資料融合(Data Fusion)處理以取得該圖資定位模組1的定位修正資訊,並得出一即時且誤差範圍在一個車道內的高精度定位。Referring to FIG. 1 to FIG. 2 , the global precision computing module 4 has a map matching sub-module 41 , an interactive multi-model sub-module 42 and a restricted lossless Kalman filter 43 . The global precision computing module 4 signal is connected to the image positioning module 1, the road visual sensing module 2 and the vehicle motion detecting module 3 for transmitting the image positioning module 1 The data positioning information, the road visual information transmitted by the road visual sensing module 2, and the motion state information transmitted by the vehicle motion detecting module 3 are performed to perform a data fusion process. The positioning correction information of the image positioning module 1 is obtained, and a high-precision positioning with an immediate error range within one lane is obtained.

於本發明的實施例,該地圖匹配子模組41係將所接收到的資訊進行一地圖匹配(Map Matching)演算處理。請參照第2圖及第3圖所示,首先,該地圖匹配子模組41依據載具目前的位置搜尋候選路段N,亦即該地圖匹配子模組41經由該全球定位系統11所取得的全球定位系統資訊予以匹配於該高精度電子地圖12中的高精度電子地圖資訊,藉此而得出圖資定位資訊。In the embodiment of the present invention, the map matching sub-module 41 performs a map matching calculation process on the received information. Referring to FIG. 2 and FIG. 3 , first, the map matching sub-module 41 searches for the candidate road segment N according to the current position of the vehicle, that is, the map matching sub-module 41 is obtained by the global positioning system 11 . The GPS information is matched to the high-precision electronic map information in the high-precision electronic map 12, thereby obtaining the map positioning information.

該地圖匹配子模組41接著進行「全面搜尋O」以執行一運算步驟P,具體而言,該運算步驟P係(1)將目前位置的投影點定位於所有的候選路段,由該全球定位系統11即時地取得該載具所在位置的經、緯度資訊,同時將該道路視覺感測模組2的道路視覺資訊、該全球定位系統11的經、緯度的資訊及該高精度電子地圖12進行座標定義與轉換,以確知該載具當下於該高精度電子地圖12所顯示的位置。(2)計算定位位置與確定投影點間的距離,將該全球定位系統資訊的經、緯度資訊、該載具周圍的道路視覺資訊及該載具於該高精度電子地圖資訊的位置資訊進行計算。(3)依據(2)的結果確認最佳候選路段,亦即確認該載具於該高精度電子地圖12上的最佳位置。以及(4)依據載具仰角及道路仰角以確認駕駛方向(順向沿著路段或反向沿著路段),係指該地圖匹配子模組41參照該高精度電子地圖資訊、該道路視覺資訊及該載具的運動狀態資訊,以確認該載具於所在路段上的駕駛行進方向。The map matching sub-module 41 then performs a "full search O" to perform an operation step P. Specifically, the operation step P (1) locates the projection point of the current position on all candidate segments, and the global positioning is performed. The system 11 obtains the latitude and longitude information of the location of the vehicle in real time, and simultaneously performs the road visual information of the road visual sensing module 2, the information of the latitude and longitude of the global positioning system 11, and the high-precision electronic map 12. The coordinates are defined and converted to ascertain that the vehicle is currently in the position displayed by the high precision electronic map 12. (2) calculating the distance between the positioning position and the determined projection point, calculating the latitude and longitude information of the global positioning system information, the road visual information around the vehicle, and the position information of the vehicle on the high-precision electronic map information. . (3) The best candidate link is confirmed based on the result of (2), that is, the optimum position of the carrier on the high-precision electronic map 12 is confirmed. And (4) confirming the driving direction according to the elevation angle of the vehicle and the elevation angle of the road (following the road section or the reverse direction along the road section), referring to the map matching sub-module 41 referring to the high-precision electronic map information, the road visual information And the motion state information of the vehicle to confirm the driving direction of the vehicle on the road section.

該地圖匹配子模組41執行「確認地圖匹配結果Q」以確認「地圖歷史資料與新地圖匹配資訊的一致性R」。具體而言,該「地圖歷史資料與新地圖匹配資訊的一致性R」的確認步驟中,首先進行(1)確認匹配路段的編號,依據該載具於該全球定位系統資訊、該高精度電子地圖資訊所顯示的位置以及該載具周圍的該道路視覺資訊進行匹配,以得知該載具所在位置的路段。(2)確認匹配路段的仰角,將該高精度電子地圖資訊所呈現路段的仰角資訊以及該慣性測量單元31所偵測得知該載具的俯仰進行匹配。(3)確認投影點(參考節點)及定位點間的近似值,即確認該全球定位系統資訊、該高精度電子地圖資訊、該道路視覺資訊及該載具的運動狀態資訊間的差異合於標準。The map matching sub-module 41 executes "confirm map matching result Q" to confirm "consistency R of map history data and new map matching information". Specifically, in the step of confirming the "consistency R of the map history data and the new map matching information", first (1) confirming the number of the matching road segment, based on the vehicle information in the global positioning system information, the high precision electronic The location displayed by the map information and the visual information of the road around the vehicle are matched to know the road segment where the vehicle is located. (2) Confirming the elevation angle of the matching road segment, matching the elevation information of the road segment presented by the high-precision electronic map information and the pitch detected by the inertial measurement unit 31 to the vehicle. (3) Confirming the approximate value between the projection point (reference node) and the positioning point, that is, confirming that the difference between the global positioning system information, the high-precision electronic map information, the road visual information, and the motion state information of the vehicle is in accordance with the standard .

該地圖匹配子模組41續行「通過一致性確認S」。當確認結果為「匹配路段T」時,該地圖匹配子模組41即「停止初始階段並輸入下一階段U」,以進行另一階段的地圖匹配工作。若確認匹配結果為否時(亦即該全球定位系統資訊、該高精度電子地圖資訊、該道路視覺資訊及該載具的運動狀態資訊間的差異過大),則該地圖匹配子模組41重新進行「全面搜尋O」以再次執行該運算步驟P。The map matching sub-module 41 continues the "pass consistency check S". When the confirmation result is "matching section T", the map matching sub-module 41 "stops the initial stage and inputs the next stage U" to perform another stage of map matching work. If it is confirmed that the matching result is no (that is, the global positioning system information, the high-precision electronic map information, the road visual information, and the difference between the motion state information of the vehicle is too large), the map matching sub-module 41 is re-established. Perform "Comprehensive Search O" to perform the operation step P again.

請參照第2圖所示,該交互式多模型子模組42係經配置以交互式多模型(IMM, Interactive Multiple Model)演算法將該圖資定位資訊、該道路視覺資訊及該運動狀態資訊進行運算,以取得一關於該圖資定位模組1的定位修正資訊。於本發明的實施例,該全球定位系統11、該慣性測量單元31及該車輛動態感知器32的原始感測器資訊經執行「確認更新及處理雜訊B」的訊號處理後,該全球定位系統資訊及該載具的運動狀態資訊的感測器狀態即傳送予該交互式多模型子模組42。並且,該地圖匹配子模組41亦將該圖資定位資訊的即時定位回饋資料傳送予該交互式多模型子模組42。藉此,該交互式多模型子模組42得以進行該載具之動態行為的狀態估測。亦即,該載具於縱向(Longitudinal)、橫向(Lateral,亦即側向)以及斜向(Slope,亦即爬坡)的運動計算。Referring to FIG. 2, the interactive multi-model sub-module 42 is configured to use an interactive multiple model (IMM) algorithm to locate the information, the road visual information, and the motion state information. Performing an operation to obtain a positioning correction information about the image positioning module 1. In the embodiment of the present invention, the global sensor system 11, the inertial measurement unit 31, and the original sensor information of the vehicle dynamic sensor 32 are processed by the signal processing of "confirm update and process noise B", and the global positioning is performed. The sensor information of the system information and the motion state information of the vehicle is transmitted to the interactive multi-model sub-module 42. Moreover, the map matching sub-module 41 also transmits the real-time positioning feedback data of the map positioning information to the interactive multi-model sub-module 42. Thereby, the interactive multi-model sub-module 42 is capable of performing state estimation of the dynamic behavior of the vehicle. That is, the vehicle is calculated in the longitudinal direction, the lateral (ie, lateral), and the oblique (Slope).

具體而言,該交互式多模型子模組42所採用交互式多模型演算法主要由交互作用(interaction)、機率模型更新(model probability update)及估測結合(estimation fusion)等階段所構成。所述交互式多模型演算法的交互作用的估計數學式如下所示: 【數學式1】其中為混合機率(mixing probability),為馬可夫轉移機率(即從模型j轉換至模型i的機率),為在k-1時刻模型i的機率,為正規化常數(normalizing constants)。而該正規化常數的數學式,如下所示: 【數學式2】各模型的狀態的數學表示式,如下所示: 【數學式3】以及,各模型共變異矩陣(covariance matrix)的初始值計算數學式如下所示: 【數學式4】其中為k-1時刻,每一載具模型所估測的結果。Specifically, the interactive multi-model algorithm used by the interactive multi-model sub-module 42 is mainly composed of an interaction, a model probability update, and an estimation fusion. The estimated mathematical expression of the interaction of the interactive multi-model algorithm is as follows: [Math 1] among them For mixing probability, For Markov transfer probability (ie the probability of converting from model j to model i), For the probability of model i at time k-1, It is normalizing constants. The mathematical formula of the normalization constant is as follows: [Math 2] The mathematical expression of the state of each model is as follows: [Math 3] And, the initial value calculation mathematical formula of each model covariance matrix is as follows: [Math 4] among them The estimated result for each vehicle model at time k-1.

而交互式多模型演算法中的機率模型更新,係根據量測值所產生的更新誤差(innovation error)而進行處理,並假設該誤差具有高斯統計性質。所述量測值的可能性方程式如下所示: 【數學式5】其中為更新向量(innovation vector),其數學式如下所示: 【數學式6】則為更新向量的共變異矩陣,其數學式如下所示: 【數學式7】因此,交互式多模型演算法中的模型機率的更新公式,如下所示: 【數學式8】其中,c為正規化常數,數學式如下所示: 【數學式9】 The probability model update in the interactive multi-model algorithm is processed according to the innovation error generated by the measured value, and the error is assumed to have Gaussian statistical properties. Probability equation for the measured value As shown below: [Math 5] among them In order to update the vector, the mathematical expression is as follows: [Math 6] and Then it is the covariation matrix of the update vector, and its mathematical expression is as follows: [Math 7] Therefore, the update formula of the model probability in the interactive multi-model algorithm is as follows: [Math 8] Where c is a normalization constant, and the mathematical expression is as follows: [Math 9]

所述交互式多模型演算法的估測結合階段,係根據上述數學式所計算而得的各模型機率,進一步採用各模型所估測出的狀態及其共變異矩陣計算出真實狀態的估測值及其共變異矩陣。其真實狀態估測值的數學式如下所示: 【數學式10】而真實狀態的估測值的共變異矩陣則如下所示: 【數學式11】 The estimation and combination phase of the interactive multi-model algorithm is based on the probability of each model calculated by the above mathematical formula, and further estimates the true state using the state estimated by each model and its covariation matrix. Value and its covariation matrix. The mathematical formula of the estimated value of the real state is as follows: [Math 10] The covariation matrix of the estimated values of the real state is as follows: [Math 11]

最後,交互式多模型子模組42依據上述交互式多模型的數學式而進行該載具動態的運算。其中,該載具的側向(lateral)動態數學式如下所示: 【數學式12】載具的水平縱向(longitudinal)動態數學式如下所示: 【數學式13】以及,載具的斜度(slope)變化動態數學式如下所示: 【數學式14】其中,X及Y為載具的座標位置,為載具的航向角,為速度,為偏航角速率,為載具斜向高度,為載具的仰角。Finally, the interactive multi-model sub-module 42 performs the dynamic calculation of the vehicle according to the mathematical formula of the interactive multi-model described above. Wherein, the lateral dynamic mathematical formula of the vehicle is as follows: [Math 12] The horizontal longitudinal mathematical formula of the vehicle is as follows: [Math 13] And, the dynamic equation of the slope change of the vehicle is as follows: [Math 14] Where X and Y are the coordinate positions of the vehicle, For the heading angle of the vehicle, For speed, For the yaw rate, For the vehicle's oblique height, It is the elevation angle of the vehicle.

請參照第2圖及第4圖所示,於本發明的實施例,該道路視覺感測模組2所感測出的道路屬性(即,道路號誌、停止線…)、該地圖匹配子模組41所演算出即時定位之圖資定位資訊以及該交互式多模型子模組42所進行載具之動態行為的狀態估測,進一步配合「限制時機I」以形成該載具的「縱向及橫向的限制條件」。該限制型無損式卡爾曼濾波器(CUKF, Constraint Unscented Kalman Filter)43接收該載具的「縱向及橫向的限制條件」以及由「確認更新及處理雜訊B」所傳送的感測器狀態,以進行定位運算及資料融合。該限制型無損式卡爾曼濾波器43將運算所得的最佳估測值傳送予該地圖匹配子模組41,以獲得該地圖匹配子模組41的即時更新之圖資定位資訊(該即時更新之圖資定位資訊再傳送予該交互式多模型子模組42)。具體而言,該限制型無損式卡爾曼濾波器43依據該地圖匹配子模組41及該載具運動偵測模組3的運動狀態資訊,而形成一限制取樣點以修正該圖資定位模組1的定位資訊。請參照第4圖所示,該限制型無損式卡爾曼濾波器43的運算模式,係以複數個取樣點K所形成的數值範圍,同時加上該「限制時機I」所形成的限制取樣點L及限制條件M,以確認出估測值J。Referring to FIG. 2 and FIG. 4, in the embodiment of the present invention, the road attribute sensed by the road visual sensing module 2 (ie, road number, stop line, ...), the map matching submodule The group 41 calculates the map positioning information of the instant positioning and the state estimation of the dynamic behavior of the vehicle carried by the interactive multi-model sub-module 42 to further cooperate with the "restriction timing I" to form the longitudinal direction of the vehicle. Horizontal restrictions." The Constraint Unscented Kalman Filter (CUKF) 43 receives the "longitudinal and lateral constraints" of the vehicle and the sensor status transmitted by "confirm update and process noise B". For positioning operations and data fusion. The limited-type lossless Kalman filter 43 transmits the calculated optimal estimated value to the map matching sub-module 41 to obtain the map update information of the map matching sub-module 41 for instant update (the instant update) The map location information is then transmitted to the interactive multi-model sub-module 42). Specifically, the limited-type lossless Kalman filter 43 forms a limit sampling point according to the motion state information of the map matching sub-module 41 and the vehicle motion detecting module 3 to correct the image positioning mode. Group 1 location information. Referring to FIG. 4, the operation mode of the limited-type lossless Kalman filter 43 is a numerical range formed by a plurality of sampling points K, and the limited sampling point formed by the "limit timing I" is added. L and the constraint M are used to confirm the estimated value J.

詳細而言,本發明的該限制型無損式卡爾曼濾波器43,係以無損式卡爾曼濾波器(UKF, Unscented Kalman Filter)的運算結果為基礎,並加上限制條件M而取得本發明精準定位的運算結果。其中,所述「限制時機」係指該限制型無損式卡爾曼濾波器43施加限制條件的時間點。例如:當該載具為暫態行為時(如,車道變換),則不施予該限制條件。反之,當載具為穩態行為時(如,維持在同一車道上),則施予該限制條件。而所述限制條件M係指現實環境中的物理限制,舉例說明,當路段上的車道寬度為3.4公尺時,且該載具皆維持該車道內行駛,則該車道寬度即為該限制條件。因此,該限制型無損式卡爾曼濾波器43所得的估測值得以落於該限制條件所限定的範圍內,而獲得一誤差範圍在一個車道內的高精度定位。In detail, the limited-type lossless Kalman filter 43 of the present invention is based on the calculation result of the UKF (Unscented Kalman Filter), and the limiting condition M is added to obtain the precision of the present invention. The result of the positioning operation. Herein, the "restricted timing" refers to a point in time when the limiting type lossless Kalman filter 43 imposes a restriction condition. For example, when the vehicle is in a transient behavior (eg, lane change), the restriction is not applied. Conversely, when the vehicle is in a steady state behavior (eg, maintained on the same lane), the constraint is imposed. The constraint condition M refers to a physical limit in a real environment. For example, when the lane width on the road section is 3.4 meters, and the vehicle is maintained in the lane, the lane width is the constraint condition. . Therefore, the estimation obtained by the limited-type lossless Kalman filter 43 is worth falling within the range defined by the constraint, and a high-precision positioning of an error range in one lane is obtained.

所述無損式卡爾曼濾波器(UKF, Unscented Kalman Filter)具有初始化、計算取樣點與權重、系統狀態與系統輸出更新及量測更新等運算階段。其中初始化數學式如下所示: 【數學式15】其中,為狀態向量,為狀態向量的矩陣。 而無損式卡爾曼濾波器的計算取樣點與權重的數學式則如下所示: 【數學式16】其中,為提供一個微調高階矩的特殊自由度,為控制sigma點分佈的參數,L為維度,通常取為零,W為權重值,為變量分佈變數。 系統狀態與系統輸出更新的數學式如下所示: 【數學式17】其中,為轉換後sigma點的向量狀態,的均值,為狀態預測的均值和共變異數。 【數學式18】其中為量測狀態,則為的均值。 無損式卡爾曼濾波器的量測更新的數學式如下所示: 【數學式19】其中為測量方差矩陣,為測量值與狀態向量相互共變異矩陣。 【數學式20】其中,為無損式卡爾曼濾波器的增益,為更新狀態向量及共變異數矩陣。The Unscented Kalman Filter (UKF) has operational stages such as initialization, calculation of sampling points and weights, system status and system output update, and measurement update. The initialization mathematics is as follows: [Math 15] among them, For the state vector, A matrix of state vectors. The mathematical formula for calculating the sampling points and weights of the lossless Kalman filter is as follows: [Math 16] among them, To provide a special degree of freedom to fine tune the higher moments, To control the parameters of the sigma point distribution, L is the dimension, Usually take zero, W is the weight value, A variable is distributed for the variable. The mathematical expressions of system status and system output update are as follows: [Math 17] among them, For the vector state of the converted sigma point, for Mean, The mean and covariance of the state prediction. [Math 18] among them To measure the state, Then Mean. The mathematical expression of the measurement update of the lossless Kalman filter is as follows: [Math 19] among them To measure the variance matrix, Covariance matrix for the measured value and the state vector. [Math 20] among them, For the gain of the lossless Kalman filter, To update the state vector and the common variance matrix.

本發明的實施例的載具即時精準定位系統透過上述該圖資定位模組1的全球定位系統11,以平價的方式而即時地獲得該載具所在位置的經、緯度資訊,並配合該高精度電子地圖12而呈現一精度為車道線等級(Lane-Level)的高準確度的道路地圖,從而提供駕駛人一精確的電子地圖(絕對定位資訊)。同時,本發明實施例的載具即時精準定位系統經由該道路視覺感測模組2的影像感測器21偵測該載具所處位置為官方所設置的道路視覺資訊(即,道路交通標誌、標線及號誌),並以該光達裝置22針對該載具與該官方設置道路視覺資訊間的縱向與側向位置修正,從而獲得即時且區域性的定位資訊(相對定位資訊)。並且,本發明實施例的載具即時精準定位系統以該載具運動偵測模組3的慣性測量單元31偵測該載具的俯仰、轉向、翻滾與轉向率,且以該車輛動態感知器32偵測該載具的車速與轉向角度,以配合該圖資定位模組1的圖資定位資訊而提升定位效果。具體而言,該載具即時精準定位系統100係藉著該全域精準運算模組4針對該圖資定位模組1的圖資定位資訊、該道路視覺感測模組2的道路視覺資訊及該載具運動偵測模組3的運動狀態資訊進行資料融合(Data fusion)處理。其中,該地圖匹配子模組41將該圖資定位資訊、該道路視覺資訊及該運動狀態資訊進行匹配,並傳送予該交互式多模型子模組42進行運算。該交互式多模型子模組42藉由該全球定位系統11、該慣性測量單元31、該車輛動態感知器32及該地圖匹配子模組41的資訊,以判斷出該載具的運動行為,亦即可即時地偵測該戴具於縱向、側向或斜向(爬坡)的運動行為而作為一模型機率指標。繼而由該限制型無損式卡爾曼濾波器43透過該模型機率指標的計算,以得到誤差範圍在一個車道內的高精度定位且相應修正該圖資定位模組1的定位資訊,進而使先進駕駛輔助系統(ADAS)能夠藉由載具即時精準定位系統準確的偵知未來道路及環境的狀況而輔助駕駛,以達到提昇的行車安全的目的。The vehicle real-time positioning system of the embodiment of the present invention obtains the latitude and longitude information of the position of the vehicle in an inexpensive manner through the global positioning system 11 of the map positioning module 1 in the above manner, and cooperates with the height. The accuracy electronic map 12 presents a highly accurate road map with a lane-level accuracy, thereby providing the driver with an accurate electronic map (absolute positioning information). At the same time, the image real-time positioning system of the embodiment of the present invention detects the location of the vehicle by the image sensor 21 of the road visual sensing module 2 as the officially set road visual information (ie, the road traffic sign) , the marking line and the number), and the longitudinal and lateral position correction between the vehicle and the officially set road visual information is obtained by the light reaching device 22, thereby obtaining instantaneous and regional positioning information (relative positioning information). Moreover, the vehicle accurate positioning system of the embodiment of the present invention detects the pitch, steering, roll and steering rate of the vehicle by the inertial measurement unit 31 of the vehicle motion detection module 3, and uses the vehicle dynamic sensor The vehicle speed and the steering angle of the vehicle are detected to match the image positioning information of the image positioning module 1 to improve the positioning effect. Specifically, the vehicle accurate positioning system 100 is configured by the global precision computing module 4 for the positioning information of the image positioning module 1 , the road visual information of the road visual sensing module 2 , and the road visual information The motion state information of the motion detection module 3 of the vehicle is subjected to data fusion processing. The map matching sub-module 41 matches the map positioning information, the road visual information, and the motion state information, and transmits the map information to the interactive multi-model sub-module 42 for calculation. The interactive multi-model sub-module 42 determines the motion behavior of the vehicle by using the information of the global positioning system 11, the inertial measurement unit 31, the vehicle dynamic sensor 32, and the map matching sub-module 41. It is also possible to instantly detect the movement behavior of the wearer in the longitudinal, lateral or oblique (climbing) as a model probability index. Then, the restricted lossless Kalman filter 43 is used to calculate the probability index of the model to obtain a high-precision positioning of the error range in one lane and correspondingly correct the positioning information of the image positioning module 1, thereby enabling advanced driving. The auxiliary system (ADAS) can assist driving by accurately detecting the future road and environment conditions by the vehicle's real-time precise positioning system to achieve improved driving safety.

以上之敘述以及說明僅為本發明之較佳實施例之說明,對於此項技術具有通常知識者當可依據以下所界定申請專利範圍以及上述之說明而作其他之修改,惟此些修改仍應是為本發明之創作精神而在本發明之權利範圍中。The above description and description are only illustrative of the preferred embodiments of the present invention, and those of ordinary skill in the art can make other modifications in accordance with the scope of the invention as defined below and the description above, but such modifications should still be It is within the scope of the invention to the spirit of the invention.

100‧‧‧載具即時精準定位系統100‧‧‧Cars Instant Accurate Positioning System

1‧‧‧圖資定位模組1‧‧‧Map positioning module

11‧‧‧全球定位系統11‧‧‧Global Positioning System

12‧‧‧高精度電子地圖12‧‧‧High-precision electronic map

2‧‧‧道路視覺感測模組2‧‧‧Road Visual Sensing Module

21‧‧‧影像感測器21‧‧‧Image Sensor

22‧‧‧光達裝置22‧‧‧Light device

3‧‧‧載具運動偵測模組3‧‧‧ Vehicle motion detection module

31‧‧‧慣性測量單元31‧‧‧ inertial measurement unit

32‧‧‧車輛動態感知器32‧‧‧Vehicle Dynamic Sensor

4‧‧‧全域精準運算模組4‧‧‧Global Precision Computing Module

41‧‧‧地圖匹配子模組41‧‧‧Map Matching Submodule

42‧‧‧交互式多模型子模組42‧‧‧Interactive multi-model sub-module

43‧‧‧限制型無損式卡爾曼濾波器43‧‧‧Restricted lossless Kalman filter

A‧‧‧先進駕駛輔助系統A‧‧‧Advanced Driver Assistance System

A1‧‧‧高精度定位A1‧‧‧High precision positioning

A2‧‧‧載具動態行為A2‧‧‧ Vehicle dynamic behavior

A3‧‧‧地圖資訊A3‧‧‧Map Information

B‧‧‧確認更新及處理雜訊B‧‧‧Confirm updates and handling of noise

I‧‧‧限制時機I‧‧‧Restricted timing

J‧‧‧估測值J‧‧‧ Estimated value

K‧‧‧取樣點K‧‧ ‧ sampling point

L‧‧‧限制取樣點L‧‧‧Restricted sampling points

M‧‧‧限制條件M‧‧‧Restrictions

O‧‧‧全面搜尋O‧‧‧Comprehensive search

P‧‧‧運算步驟P‧‧‧ arithmetic steps

Q‧‧‧確認地圖匹配結果Q‧‧‧Confirm map match results

R‧‧‧確認地圖歷史資料與新地圖匹配資訊的一致性R‧‧‧Confirm the consistency of map historical data and new map matching information

S‧‧‧通過一致性確認S‧‧‧Confirmed by consistency

T‧‧‧匹配路段T‧‧‧ matching sections

U‧‧‧停止初始階段並輸入下一階段U‧‧‧Stop the initial phase and enter the next phase

第1圖為顯示根據本發明的一實施例的載具即時精準定位系統的系統架構示意圖; 第2圖為顯示本發明的實施例的載具即時精準定位系統的運算流程架構的示意圖; 第3圖為顯示地圖匹配演算法的流程示意圖; 第4圖為顯示限制型無損式卡爾曼濾波器進行施加限制取樣點之運算的示意圖。1 is a schematic diagram showing a system architecture of a vehicle instant precise positioning system according to an embodiment of the present invention; FIG. 2 is a schematic diagram showing an operation flow architecture of a vehicle instant precise positioning system according to an embodiment of the present invention; The figure shows the flow chart of the map matching algorithm. The fourth figure shows the operation of the restricted type lossless Kalman filter to impose the limit sampling point.

Claims (5)

一種載具即時精準定位系統,係對於一載具予以提供即時精準定位資訊,該載具即時精準定位系統包含: 一圖資定位模組,設有一全球定位系統及一高精度電子地圖,該全球定位系統取得的全球定位系統資訊,該高精度電子地圖具有高精度電子地圖資訊; 一道路視覺感測模組,係經配置以取得該載具所在道路之道路視覺資訊; 一載具運動偵測模組,係經配置以取得該載具的運動狀態資訊;以及 一全域精準運算模組,訊號連接於該圖資定位模組、該道路視覺感測模組及該載具運動偵測模組,該全域精準運算模組將該全球定位系統資訊及高精度電子地圖資訊予以匹配而得出圖資定位資訊,且具有一交互式多模型子模組及一限制型無損式卡爾曼濾波器,以將由該圖資定位模組所傳送之該圖資定位資訊、由該道路視覺感測模組所傳送之該道路視覺資訊及由該載具運動偵測模組所傳送之該運動狀態資訊予以執行一資料融合處理以得出一即時且誤差範圍在一個車道內的高精度定位。A real-time accurate positioning system for a vehicle provides instant and accurate positioning information for a vehicle. The instant positioning system of the vehicle includes: a positioning positioning module, a global positioning system and a high-precision electronic map, the world Global positioning system information obtained by the positioning system, the high-precision electronic map has high-precision electronic map information; a road visual sensing module is configured to obtain road visual information of the road where the vehicle is located; The module is configured to obtain information on the motion state of the vehicle; and a global precision computing module, the signal is connected to the image positioning module, the road visual sensing module and the vehicle motion detecting module The global precision computing module matches the global positioning system information and the high-precision electronic map information to obtain map positioning information, and has an interactive multi-model sub-module and a limited-loss non-destructive Kalman filter. The map positioning information transmitted by the map positioning module, the road visual information transmitted by the road visual sensing module, and The motion state information transmitted by the vehicle motion detection module performs a data fusion process to obtain a high-precision positioning with an immediate and error range within one lane. 如請求項第1項所述之載具即時精準定位系統,其中該道路視覺感測模組具有一影像感測器及一光達裝置,該影像感測器係經配置以偵測該載具所處位置為官方所設置的道路視覺資訊,該光達裝置係經配置以量測該載具與該道路視覺資訊間的距離並修正該道路視覺資訊的內容,該全域精準運算模組針對該圖資定位資訊、該道路視覺資訊進行資料融合處理以取得該圖資定位模組的定位修正資訊。The instant visual positioning system of the present invention, wherein the road visual sensing module has an image sensor and a light device, the image sensor being configured to detect the vehicle The position is an officially set road visual information, and the optical device is configured to measure a distance between the vehicle and the road visual information and correct the content of the road visual information, wherein the global precision computing module is The map positioning information and the road visual information are subjected to data fusion processing to obtain positioning correction information of the map positioning module. 如請求項第1項所述之載具即時精準定位系統,其中該全域精準運算模組設有一地圖匹配子模組,該地圖匹配子模組經配置將該全球定位系統資訊及高精度電子地圖資訊予以匹配而得出該圖資定位資訊,且將該圖資定位資訊、該道路視覺資訊及該運動狀態資訊進行匹配並傳送予該交互式多模型子模組進行該載具於縱向運動、橫向運動及斜向運動的運算。The instant precise positioning system of the vehicle of claim 1, wherein the global precision computing module is provided with a map matching sub-module configured to provide global positioning system information and a high-precision electronic map. The information is matched to obtain the map positioning information, and the map positioning information, the road visual information and the motion state information are matched and transmitted to the interactive multi-model sub-module to perform longitudinal movement of the vehicle. The operation of lateral motion and oblique motion. 如請求項第3項所述之載具即時精準定位系統,其中該載具運動偵測模組具有一慣性測量單元及一車輛動態感知器,該慣性測量單元係經配置以偵測該載具的俯仰、轉向、翻滾與轉向率,該車輛動態感知器係經配置以偵測該載具的輪速與轉向角度,該交互式多模型子模組針對該載具運動偵測模組的運動狀態資訊、該圖資定位資訊及該地圖匹配子模組進行資料融合處理以取得該載具的定位修正資訊,該載具的定位修正資訊係作為該限制型無損式卡爾曼濾波器對於該圖資定位模組的一定位運算限制條件。The vehicle of claim 3, wherein the vehicle motion detection module has an inertial measurement unit and a vehicle motion sensor, the inertial measurement unit configured to detect the vehicle The vehicle's dynamic sensor is configured to detect the wheel speed and steering angle of the vehicle, and the interactive multi-model sub-module is configured for the motion detection module of the vehicle. The status information, the map positioning information, and the map matching sub-module perform data fusion processing to obtain positioning correction information of the vehicle, and the positioning correction information of the vehicle is used as the limited-type lossless Kalman filter. A positioning operation limitation condition of the positioning module. 如請求項第3項所述之載具即時精準定位系統,其中該限制型無損式卡爾曼濾波器經配置依據該地圖匹配子模組及該交互式多模型子模組進行資料融合,且形成一限制取樣點以修正該圖資定位模組的定位資訊。The instant accurate positioning system of the vehicle of claim 3, wherein the limited-type lossless Kalman filter is configured to perform data fusion according to the map matching sub-module and the interactive multi-model sub-module, and form A limit sampling point is used to correct the positioning information of the image positioning module.
TW106123893A 2017-07-18 2017-07-18 Real-time precise positioning system of vehicle TWI635302B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW106123893A TWI635302B (en) 2017-07-18 2017-07-18 Real-time precise positioning system of vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW106123893A TWI635302B (en) 2017-07-18 2017-07-18 Real-time precise positioning system of vehicle

Publications (2)

Publication Number Publication Date
TWI635302B TWI635302B (en) 2018-09-11
TW201908765A true TW201908765A (en) 2019-03-01

Family

ID=64452748

Family Applications (1)

Application Number Title Priority Date Filing Date
TW106123893A TWI635302B (en) 2017-07-18 2017-07-18 Real-time precise positioning system of vehicle

Country Status (1)

Country Link
TW (1) TWI635302B (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI679512B (en) * 2018-10-05 2019-12-11 東元電機股份有限公司 Automated guided vehicle
TWI731634B (en) * 2020-03-25 2021-06-21 緯創資通股份有限公司 Moving path determining method and wireless localization device

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006309623A (en) * 2005-04-28 2006-11-09 Aquaheim:Kk Collision warning equipment and vehicle using the same
US7590481B2 (en) * 2005-09-19 2009-09-15 Ford Global Technologies, Llc Integrated vehicle control system using dynamically determined vehicle conditions
TWI357493B (en) * 2007-10-12 2012-02-01 Grt Tech Co Ltd Augmented navigation system and method of a moving
DE102011081892A1 (en) * 2011-08-31 2013-02-28 Robert Bosch Gmbh Method for lane monitoring and lane monitoring system for a vehicle
CN106441319B (en) * 2016-09-23 2019-07-16 中国科学院合肥物质科学研究院 A kind of generation system and method for automatic driving vehicle lane grade navigation map

Also Published As

Publication number Publication date
TWI635302B (en) 2018-09-11

Similar Documents

Publication Publication Date Title
CN110631593B (en) Multi-sensor fusion positioning method for automatic driving scene
CN106767853B (en) Unmanned vehicle high-precision positioning method based on multi-information fusion
US9952597B2 (en) Apparatus for correcting vehicle location
CN109416256B (en) Travel lane estimation system
US10481277B2 (en) Position correction of a vehicle by referencing to objects in the surroundings
US8498813B2 (en) Navigation device, method, and program
RU2254558C2 (en) Method of correction of position error in navigation system
EP2224208B1 (en) Navigation device and navigation method
Tao et al. Lane marking aided vehicle localization
US8396659B2 (en) Navigation device, method, and program
JP2022113746A (en) Determination device
US20060047423A1 (en) Navigation system and method for detecting deviation of mobile objects from route using same
US20100121518A1 (en) Map enhanced positioning sensor system
TWI522258B (en) Based on electronic map, global navigation satellite system and vehicle motion detection technology Lane identification method
US11615711B2 (en) Precision localization and geofencing governance system and method for light electric vehicles
CN111025366B (en) Grid SLAM navigation system and method based on INS and GNSS
KR101553898B1 (en) System and method for estimating position of autonomous vehicle using position information of geographic feature
US11579628B2 (en) Method for localizing a vehicle
JP2006284281A (en) Own vehicle information recognition device and method
TWI635302B (en) Real-time precise positioning system of vehicle
US20200200870A1 (en) Radar Sensor Misalignment Detection for a Vehicle
KR20120086571A (en) Vehicle navigation apparatus and method
US20220404170A1 (en) Apparatus, method, and computer program for updating map
KR20200119092A (en) Vehicle and localization method thereof
TWI724686B (en) Positioning and orientation system and positioning and orientation method using high definition maps