TWI725611B - 高爾夫球場自駕車輛之車輛導航切換設備 - Google Patents

高爾夫球場自駕車輛之車輛導航切換設備 Download PDF

Info

Publication number
TWI725611B
TWI725611B TW108140974A TW108140974A TWI725611B TW I725611 B TWI725611 B TW I725611B TW 108140974 A TW108140974 A TW 108140974A TW 108140974 A TW108140974 A TW 108140974A TW I725611 B TWI725611 B TW I725611B
Authority
TW
Taiwan
Prior art keywords
navigation
module
self
golf course
vehicle
Prior art date
Application number
TW108140974A
Other languages
English (en)
Other versions
TW202118995A (zh
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 TW108140974A priority Critical patent/TWI725611B/zh
Priority to CN202010784095.6A priority patent/CN112859107B/zh
Priority to JP2020142057A priority patent/JP7209367B2/ja
Priority to KR1020200113703A priority patent/KR102373825B1/ko
Application granted granted Critical
Publication of TWI725611B publication Critical patent/TWI725611B/zh
Publication of TW202118995A publication Critical patent/TW202118995A/zh

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/86Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C11/00Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Electromagnetism (AREA)
  • Multimedia (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Business, Economics & Management (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Game Theory and Decision Science (AREA)
  • Medical Informatics (AREA)

Abstract

一種高爾夫球場自駕車輛之車輛導航切換設備包含一第一導航裝置、一第二導航裝置及一運動控制裝置,該第一導航裝置包括一二維光學雷達模組,該第二導航裝置包括一全球衛星導航系統模組,該運動控制裝置根據該第一導航裝置的第一導航位置信賴值及該第二導航裝置的第二導航位置信賴值而選擇使用該第一導航裝置之第一導航位置結果及該第二導航裝置之第二導航位置結果中單一個導航位置結果而控制該高爾夫球場自駕車輛在一自駕區域中進行自動駕駛。

Description

高爾夫球場自駕車輛之車輛導航切換設備
本發明相關於一種自動駕駛車輛,特別是相關於一種高爾夫球場自駕車輛之車輛導航切換設備。
自動駕駛車輛,又稱為無人駕駛車輛、電腦駕駛車輛,是一種能夠根據環境感測結果及少量或無須人類操作而自動行駛的車輛。近年來,隨著對於車輛的決策判斷、命令傳達、機構動作等的研究不斷投入,自動駕駛車輛的技術也取得飛躍性的發展。
自動駕駛車輛的行駛仰賴於導航裝置,無論是行駛路徑的規劃或即時路況的應變,導航裝置都需要在精準定位下才能作出正確的判斷,得到準確的導航位置結果。
目前,自動駕駛車輛的其中一個主流應用是在有限區域內執行高等級(等級4以上)的自動駕駛。在此類應用中,自動駕駛車輛通常是沿著有限區域內的一般車用道路行駛,如此的車用道路其路面狀態及道路環境單純,故一般市售的導航裝置大多有能力因應,提供堪用的導航位置結果。
然而,當自動駕駛車輛應用作為行駛在高爾夫球場的球道及車道兩方面的高爾夫球車時,因路面狀態及道路環境等條件不再單純,而是會隨著車道的柏油路、球道的高低起伏、球道整修狀況、風勢、雨勢、與前後組自動駕駛車輛的距離等因素,致使習知的導航裝置應用在高爾夫球之球道中會有不足之處,造成自動駕駛車輛行駛於球道時則容易發生誤判及迷航。
鑒於以上所述,習知的導航裝置無法適應高爾夫球之球道、路面狀態及高爾夫球之球道整體環境等條件的劇烈變化,而有導致自動駕駛車輛技術難以應用在高爾夫球場中的問題。
緣此,本發明的目的即在提供一種高爾夫球場自駕車輛之車輛導航切換設備,能夠對於應用在高爾夫球場中行駛的高爾夫球場自駕車輛穩定地提供準確的導航位置結果。
本發明為解決習知技術之問題所採用之技術手段係提供一種高爾夫球場自駕車輛之車輛導航切換設備,係以一高爾夫球場的球道作為一自駕區域,而在該自駕區域中自動切換該高爾夫球場自駕車輛的導航方式,該高爾夫球場自駕車輛之車輛導航切換設備包含:一第一導航裝置,包括一二維光學雷達模組、一攝影模組、一第一定位模組及一第一路徑規劃模組,該第一定位模組連接於該二維光學雷達模組及該攝影模組,該第一路徑規劃模組連接於該第一定位模組,該第一導航裝置根據該二維光學雷達模組與該攝影模組之感測及該第一定位模組與該第一路徑規劃模組之運算而得到該高爾夫球場自駕車輛於該自駕區域中的一第一導航位置結果及一第一導航位置信賴值;一第二導航裝 置,包括一全球衛星導航系統模組、一第二定位模組及一第二路徑規劃模組,該第二定位模組連接於該全球衛星導航系統模組,該第二路徑規劃模組連接於該第二定位模組,該第二導航裝置根據該全球衛星導航系統模組之感測及該第二定位模組與該第二路徑規劃模組之運算而得到該高爾夫球場自駕車輛於該自駕區域中的一第二導航位置結果及一第二導航位置信賴值;以及一運動控制裝置,包括一導航選擇切換模組及一運動控制模組,該導航選擇切換模組連接於該運動控制模組,該導航選擇切換模組經設置而根據該第一導航裝置的該第一導航位置信賴值及該第二導航裝置的該第二導航位置信賴值,而將該運動控制模組自該第一導航裝置切換成連接於該第二導航裝置或是將該運動控制模組自該第二導航裝置切換成連接於該第一導航裝置,而使該運動控制模組根據該第一導航裝置之第一導航位置結果及該第二導航裝置之第二導航位置結果中單一個導航位置結果而控制該高爾夫球場自駕車輛在該自駕區域中進行自動駕駛,其中該第一導航裝置之該第一導航位置信賴值係根據該二維光學雷達模組、該攝影模組及該第一定位模組的運算機率模型而取得,該第二導航裝置之該第二導航位置信賴值係根據該全球衛星導航系統模組及該第二定位模組之運算資訊以及根據該高爾夫球場自駕車輛的車輛動態暨道路動態擷取資訊而取得。
在本發明的一實施例中係提供一種高爾夫球場自駕車輛之車輛導航切換設備,其中該第一定位模組係為一即時定位暨地圖構建模組。
在本發明的一實施例中係提供一種高爾夫球場自駕車輛之車輛導航切換設備,其中該第一定位模組所使用的地圖資料包括高精度電子地圖資料。
在本發明的一實施例中係提供一種高爾夫球場自駕車輛之車輛導航切換設備,其中該高精度電子地圖資料包括雷射點雲地圖資料、地理資訊系統地圖資料及經緯座標資料。
在本發明的一實施例中係提供一種高爾夫球場自駕車輛之車輛導航切換設備,其中該第二定位模組包括一慣性測量單元、一卡爾曼濾波器單元、一地圖匹配單元及一位置增強單元,該卡爾曼濾波器單元連接於該全球衛星導航系統模組及該慣性測量單元,該地圖匹配單元連接於該卡爾曼濾波器單元,該位置增強單元連接於該地圖匹配單元。
在本發明的一實施例中係提供一種高爾夫球場自駕車輛之車輛導航切換設備,其中該第二定位模組所使用的地圖資料包括地理資訊系統地圖資料及經緯座標資料。
經由本發明所採用之技術手段,高爾夫球場自駕車輛之車輛導航切換設備能夠因應高爾夫球之球道、路面狀態及高爾夫球之球道整體等條件的變化,以建置成本較為經濟的方式,而隨時在2D光學導航(輔以攝影機)及衛星導航之間自動切換,以使用具有較佳導航位置信賴值的導航位置結果。藉此,無論高爾夫球場自駕車輛是行駛在一般道路、高爾夫球場的球道或是在二者之間往來,高爾夫球場自駕車輛之車輛導航切換設備都能夠穩定地提供準確的導航位置結果,以避免高爾夫球場自駕車輛發生誤判或迷航,從而確保乘客的安全,給予良好的搭乘體驗。如前述,本發明的高爾夫球場自駕車輛之車輛導航切換設備所採用的是二維光學雷達模組,價格比起三維光學雷達模組更為低廉,能有效降低成本,且以二維光學雷達模組設置,則不必須設置於車頂,且由於攝影機具有顏色辨識能力,可輔助地更正確辨識高爾夫球場中的特定標 誌,以在天候不佳時輔助辨識高爾夫球自駕車輛的位置。如此藉由可以光學導航的方式進行導航亦可避免由於網路傳送失誤造成的導航指令延遲或錯誤。
100:高爾夫球場自駕車輛之車輛導航切換設備
1:第一導航裝置
11:二維光學雷達模組
12:攝影模組
13:第一定位模組
14:第一路徑規劃模組
2:第二導航裝置
21:全球衛星導航系統模組
22:第二定位模組
221:慣性測量單元
222:卡爾曼濾波器單元
223:地圖匹配單元
224:位置增強單元
23:第二路徑規劃模組
3:運動控制裝置
31:導航選擇切換模組
32:運動控制模組
A:自駕區域
C:高爾夫球場自駕車輛
L1:第一導航位置信賴值
L2:第二導航位置信賴值
M:高精度電子地圖資料
M1:雷射點雲地圖資料
M2:地理資訊系統地圖資料
M3:經緯座標資料
N1:第一導航位置結果
N2:第二導航位置結果
〔第1圖〕為顯示根據本發明的一實施例的高爾夫球場自駕車輛之車輛導航切換設備的示意圖;〔第2a圖〕為顯示使用有根據本發明的實施例的高爾夫球場自駕車輛之車輛導航切換設備的高爾夫球場自駕車輛應用在高爾夫球場時的示意圖;〔第2b圖〕為顯示使用有根據本發明的實施例的高爾夫球場自駕車輛之車輛導航切換設備的高爾夫球場自駕車輛自車道進入球道時的示意圖;〔第2c圖〕為顯示使用有根據本發明的實施例的高爾夫球場自駕車輛之車輛導航切換設備的高爾夫球場自駕車輛行駛於球道時的示意圖;〔第2d圖〕為顯示使用有根據本發明的實施例的高爾夫球場自駕車輛之車輛導航切換設備的高爾夫球場自駕車輛自球道進入車道時的示意圖;〔第2e圖〕為顯示使用有根據本發明的實施例的高爾夫球場自駕車輛之車輛導航切換設備的高爾夫球場自駕車輛行駛於車道時的示意圖。
以下根據第1圖至第2e圖,而說明本發明的實施方式。該說明並非為限制本發明的實施方式,而為本發明之實施例的一種。
如第1圖至第2e圖所示,依據本發明的一實施例的一種高爾夫球場自駕車輛之車輛導航切換設備100係以一高爾夫球場的球道作為一自駕區域A,而在該自駕區域A中導航一高爾夫球場自駕車輛C。該高爾夫球場自駕車輛之車輛導航切換設備100包含:一第一導航裝置1、一第二導航裝置2及一運動控制裝置3。
如第1圖所示,該第一導航裝置1包括一二維光學雷達模組11、一攝影模組12及一第一定位模組13及一第一路徑規劃模組14。該第一定位模組13連接於該二維光學雷達模組11及該攝影模組12,該第一路徑規劃模組14連接於該第一定位模組13,該第一導航裝置1根據該二維光學雷達模組11與該攝影模組12之感測及該第一定位模組13與該第一路徑規劃模組14之運算而得到該高爾夫球場自駕車輛C於該自駕區域A的一第一導航位置結果N1及一第一導航位置信賴值L1。
具體而言,該二維光學雷達模組11係為使用光學雷達(light detection and ranging;LiDAR)的模組。LiDAR是一種光學遙感技術,其原理係藉由以脈衝雷射光照射目標並以感測器量測反射脈衝而量測與目標間的距離。二維光學雷達模組11在本實施例中為二維機械掃描型光學雷達(2D Mechanical Scanning Lidar),其藉由雷射/接收組件的機械旋轉或是利用旋轉鏡引導光束,而在360°的廣範圍區域收集資料。當然,本發明不限於此,二維光學雷達模組11亦可為二維固態光學雷達(2D Solid State Lidar),其具有平面的感測元件而沒有旋轉元件,故體積小、重量輕。無論是哪一種的二維光學雷達模組11,其價格皆比三維光學雷達更為低廉而且不限於安裝於車頂,而能有效降低成本。該攝影模組12用於透過攝影而取得攝影資料,而利用該攝影資料與該二維光學雷 達模組11的感測結果不斷進行與地圖資料之比對而得到即時且準確的結果。在本實施例中,該攝影模組12為光學攝影機,透過機器視覺演算法,擁有較佳的物體辨識能力,能夠分辨顏色、標線、交通號誌等。藉此,應用在高爾夫球場時,該攝影模組12能夠利用高爾夫球場的草坪等環境的顏色以及場地上的各種標誌的辨識(例如:高爾夫球場為了此高爾夫球自駕車輛而設置的顏色標誌),來輔助該二維光學雷達模組11,以作出比對於該地圖資料後之清楚判讀,有效提高判斷準確度,不容易發生誤判。在本發明中,該二維光學雷達模組11及該攝影模組12可同時提供為多數個,以獲得更完整且更準確的感測效果。且,該二維光學雷達模組11及該攝影模組12不限於設置成朝向同一方向或朝向前方,而可以視需求而設置成朝向不同方向或朝向任意方向。例如,該二維光學雷達模組11設置成對於前方進行感測時,該攝影模組12能夠設置成對於左右二個方向進行攝影,以輔助該二維光學雷達模組11,而解決該二維光學雷達模組11在同一時間只能感測前方而無法同時感測左右二個方向的問題。該第一定位模組13在本實施例中係為一即時定位暨地圖構建(Simultaneous Localization and Mapping;SLAM)模組,即時定位暨地圖構建的概念係在構建或更新未知環境地圖的同時,並可追蹤所在位置,從而達到同時定位和地圖構建的目的。該第一路徑規劃模組14用於執行路徑規劃(Path Planning),模擬得出自駕車輛的運動路徑。
如第1圖所示,依據本發明的實施例的高爾夫球場自駕車輛之車輛導航切換設備100,該第一定位模組13所使用的地圖資料包括高精度電子地圖(HD Map)資料M,其中在本實施例中,該高精度電子地圖資料M包括雷射點雲地圖(Laser Point Cloud Map)資料M1、地理資訊系統(Geographic Information System;GIS)地圖資料M2及經緯座標資料M3。具體而言,在本實施例中,該第一導航裝置1運用該二維光學雷達模組11及該攝影模組12等所提供的感測資訊,並使用包含該雷射點雲地圖資料M1、該地理資訊系統地圖資料M2及該經緯座標資料M3的該高精度電子地圖資料M,達成自主定位,而得到該高爾夫球場自駕車輛C於該自駕區域A中的該第一導航位置結果N1。
如第1圖所示,該第二導航裝置2包括一全球衛星導航系統模組21、一第二定位模組22及一第二路徑規劃模組23,該第二定位模組22連接於該全球衛星導航系統模組21,該第二路徑規劃模組23連接於該第二定位模組22,該第二定位模組22根據該全球衛星導航系統模組21之感測及該第二定位模組22與該第二路徑規劃模組23之運算而得到該高爾夫球場自駕車輛C於該自駕區域A中的該第二導航位置結果N2。
具體而言,該全球衛星導航系統模組21係為使用全球衛星導航系統(Global Navigation Satellite System;GNSS)的模組,例如美國的全球定位系統(Global Positioning System;GPS)便是全球衛星導航系統的其中一種。如第1圖所示,該第二定位模組22在本實施例中包括一慣性測量單元221、一卡爾曼濾波器(Kalman Filter)單元222、一地圖匹配(Map Matching)單元223及一位置增強(Position Enhancement)單元224。該卡爾曼濾波器單元222連接於該全球衛星導航系統模組21及該慣性測量單元221,該地圖匹配單元223連接於該卡爾曼濾波器單元222,該位置增強單元224連接於該地圖匹配單元223。該第二路徑規劃模組23也是執行路徑規劃的模組,用於模擬得出自駕車輛的運動路徑。
如第1圖所示,依據本發明的實施例的高爾夫球場自駕車輛之車輛導航切換設備100,該第二定位模組22所使用的地圖資料包括地理資訊系統地圖 資料M2及經緯座標資料M3。相似地,該第二導航裝置2運用該全球衛星導航系統模組21等所提供的感測資訊,並使用該地理資訊系統地圖資料M2及該經緯座標資料M3,達成自主定位,而得到該高爾夫球場自駕車輛C於該自駕區域A中的該第二導航位置結果N2。
該運動控制裝置3包括一導航選擇切換模組31及一運動控制模組32。該導航選擇切換模組31連接於該運動控制模組32,該導航選擇切換模組31經設置而根據該第一導航裝置1的該第一導航位置信賴值L1及該第二導航裝置2的該第二導航位置信賴值L2,而將該運動控制模組32自該第一導航裝置1切換成連接於該第二導航裝置2或是將該運動控制模組32自該第二導航裝置2切換成連接於該第一導航裝置1,而使該運動控制模組32根據該第一導航裝置1之第一導航位置結果N1及該第二導航裝置2之第二導航位置結果N2中單一個導航位置結果而控制該高爾夫球場自駕車輛C在該自駕區域A中進行自動駕駛。
依據本發明的實施例的高爾夫球場自駕車輛之車輛導航切換設備100,該第一導航位置信賴值L1是針對該第一導航裝置1之第一導航位置結果N1的信賴水準(Confidence Level)的估計值,該第二導航位置信賴值L2是針對該第二導航裝置2之第二導航位置結果N2的信賴水準的估計值。信賴水準(Confidence Level)是統計學中用於評估對象結果的準確性,即,可信賴的程度,的一個指標。在本發明中,該第一導航裝置1之第一導航位置信賴值L1及該第二導航裝置2之第二導航位置信賴值L2則是分別用於評估該第一導航裝置1之第一導航位置結果N1及該第二導航裝置2之第二導航位置結果N2的準確性,其中該第一導航裝置1之第一導航位置信賴值L1係根據該二維光學雷達模組11、該攝影模組12及該第一定位模組13的運算機率模型而取得,該第二導航裝置2之第 二導航位置信賴值L2係根據該全球衛星導航系統模組21及該第二定位模組22之運算資訊以及根據該高爾夫球場自駕車輛C的車輛動態暨道路動態擷取資訊而取得。
如第2a圖至第2e圖所示,在使用有該高爾夫球場自駕車輛之車輛導航切換設備100的高爾夫球場自駕車輛C應用在高爾夫球場(該自駕區域A)的情況下,當該高爾夫球場自駕車輛C行駛於車道時(如第2a圖),該高爾夫球場自駕車輛之車輛導航切換設備100可選擇導航位置信賴值較高的導航位置結果(例如,第一導航位置結果N1),而據以控制該高爾夫球場自駕車輛C在該自駕區域A中自動駕駛。並且,隨著路面狀態及道路環境的劇烈改變(例如,如第2b圖所示的自車道進入球道或是如第2d圖所示的自球道回到車道),該高爾夫球場自駕車輛之車輛導航切換設備100隨時可切換為選擇當下導航位置信賴值較高的導航位置結果(例如,自該第一導航位置結果N1改為選擇該第二導航位置結果N2或是自該第二導航位置結果N2返回到選擇該第一導航位置結果N1),而據以控制該高爾夫球場自駕車輛C在該自駕區域A中自動駕駛。當然,導航位置結果的切換選擇方式並不以上述選擇導航位置信賴值較高者的方式為限。在其他實施方式中,亦可針對該第一導航裝置1之第一導航位置信賴值L1及該第二導航裝置2之第二導航位置信賴值L2個別設定切換用的閾值(上限閾值及/或下限閾值),只有在目前被選擇的導航位置結果的導航位置信賴值低於下限閾值及/或目前未被選擇的導航位置結果的導航位置信賴值高於上限閾值時,該導航選擇切換模組31才會進行導航裝置之切換連接。
藉由上述方式,本發明的高爾夫球場自駕車輛之車輛導航切換設備100能夠因應高爾夫球之球道、路面狀態及高爾夫球之球道整體等條件的變化, 以建置成本較為經濟的方式,而隨時在2D光學導航(輔以攝影機)及衛星導航之間自動切換,以使用具有較佳導航位置信賴值的導航位置結果(該第一導航位置結果N1及該第二導航位置結果N2中單一個導航位置結果)。藉此,無論該高爾夫球場自駕車輛C是行駛在一般道路、高爾夫球場的球道或是在二者之間往來,該高爾夫球場自駕車輛之車輛導航切換設備100都能夠穩定地提供準確的導航位置結果,以避免該高爾夫球場自駕車輛C發生誤判或迷航,從而確保乘客的安全,給予良好的搭乘體驗。如前述,本發明的高爾夫球場自駕車輛之車輛導航切換設備100所採用的是二維光學雷達模組11,價格比起三維光學雷達模組更為低廉,能有效降低成本,且以二維光學雷達模組11設置,則不必須設置於車頂,且由於攝影機具有顏色辨識能力,可輔助地更正確辨識高爾夫球場中的特定標誌,以在天候不佳時輔助辨識高爾夫球自駕車輛的位置。如此藉由可以光學導航的方式進行導航亦可避免由於網路傳送失誤造成的導航指令延遲或錯誤。
以上之敘述以及說明僅為本發明之較佳實施例之說明,對於此項技術具有通常知識者當可依據以下所界定申請專利範圍以及上述之說明而作其他之修改,惟此些修改仍應是為本發明之發明精神而在本發明之權利範圍中。
100:高爾夫球場自駕車輛之車輛導航切換設備
1:第一導航裝置
11:二維光學雷達模組
12:攝影模組
13:第一定位模組
14:第一路徑規劃模組
2:第二導航裝置
21:全球衛星導航系統模組
22:第二定位模組
221:慣性測量單元
222:卡爾曼濾波器單元
223:地圖匹配單元
224:位置增強單元
23:第二路徑規劃模組
3:運動控制裝置
31:導航選擇切換模組
32:運動控制模組
C:高爾夫球場自駕車輛
L1:第一導航位置信賴值
L2:第二導航位置信賴值
M:高精度電子地圖資料
M1:雷射點雲地圖資料
M2:地理資訊系統地圖資料
M3:經緯座標資料
N1:第一導航位置結果
N2:第二導航位置結果

Claims (6)

  1. 一種高爾夫球場自駕車輛之車輛導航切換設備,係以一高爾夫球場的球道作為一自駕區域,而在該自駕區域中自動切換該高爾夫球場自駕車輛的導航方式,該高爾夫球場自駕車輛之車輛導航切換設備包含:一第一導航裝置,包括一二維光學雷達模組、一攝影模組、一第一定位模組及一第一路徑規劃模組,該攝影模組用於透過攝影而感測取得攝影資料,該第一定位模組連接於該二維光學雷達模組及該攝影模組,該第一路徑規劃模組連接於該第一定位模組,該第一導航裝置根據該二維光學雷達模組與該攝影模組之感測及該第一定位模組與該第一路徑規劃模組之運算而得到該高爾夫球場自駕車輛於該自駕區域中的一第一導航位置結果及一第一導航位置信賴值;一第二導航裝置,包括一全球衛星導航系統模組、一第二定位模組及一第二路徑規劃模組,該第二定位模組連接於該全球衛星導航系統模組,該第二路徑規劃模組連接於該第二定位模組,該第二導航裝置根據該全球衛星導航系統模組之感測及該第二定位模組與該第二路徑規劃模組之運算而得到該高爾夫球場自駕車輛於該自駕區域中的一第二導航位置結果及一第二導航位置信賴值;以及一運動控制裝置,包括一導航選擇切換模組及一運動控制模組,該導航選擇切換模組連接於該運動控制模組,該導航選擇切換模組經設置而根據該第一導航裝置的該第一導航位置信賴值及該第二導航裝置的該第二導航位置信賴值,而將該運動控制模組自該第一導航裝置切換成連接於該第二導航裝置或是將該運動控制模組自該第二導航裝置切換成連接於該第一導航裝置,而使該運動控制模組根據該第一導航裝置之第一導航位置結果及該第二導航裝置之第二導航 位置結果中單一個導航位置結果而控制該高爾夫球場自駕車輛在該自駕區域中進行自動駕駛,其中該第一導航裝置之該第一導航位置信賴值係根據該二維光學雷達模組、該攝影模組及該第一定位模組的運算機率模型而取得,該第二導航裝置之該第二導航位置信賴值係根據該全球衛星導航系統模組及該第二定位模組之運算資訊以及根據該高爾夫球場自駕車輛的車輛動態暨道路動態擷取資訊而取得。
  2. 如請求項1所述之高爾夫球場自駕車輛之車輛導航切換設備,其中該第一定位模組係為一即時定位暨地圖構建模組。
  3. 如請求項1所述之高爾夫球場自駕車輛之車輛導航切換設備,其中該第一定位模組所使用的地圖資料包括高精度電子地圖資料。
  4. 如請求項3所述之高爾夫球場自駕車輛之車輛導航切換設備,其中該高精度電子地圖資料包括雷射點雲地圖資料、地理資訊系統地圖資料及經緯座標資料。
  5. 如請求項1所述之高爾夫球場自駕車輛之車輛導航切換設備,其中該第二定位模組包括一慣性測量單元、一卡爾曼濾波器單元、一地圖匹配單元及一位置增強單元,該卡爾曼濾波器單元連接於該全球衛星導航系統模組及該慣性測量單元,該地圖匹配單元連接於該卡爾曼濾波器單元,該位置增強單元連接於該地圖匹配單元。
  6. 如請求項1或5所述之高爾夫球場自駕車輛之車輛導航切換設備,其中該第二定位模組所使用的地圖資料包括地理資訊系統地圖資料及經緯座標資料。
TW108140974A 2019-11-12 2019-11-12 高爾夫球場自駕車輛之車輛導航切換設備 TWI725611B (zh)

Priority Applications (4)

Application Number Priority Date Filing Date Title
TW108140974A TWI725611B (zh) 2019-11-12 2019-11-12 高爾夫球場自駕車輛之車輛導航切換設備
CN202010784095.6A CN112859107B (zh) 2019-11-12 2020-08-06 高尔夫球场自驾车辆的车辆导航切换设备
JP2020142057A JP7209367B2 (ja) 2019-11-12 2020-08-25 ゴルフ場自動運転車のナビゲーション切り替え設備
KR1020200113703A KR102373825B1 (ko) 2019-11-12 2020-09-07 골프장 자동 운전차의 내비게이션 전환 설비

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW108140974A TWI725611B (zh) 2019-11-12 2019-11-12 高爾夫球場自駕車輛之車輛導航切換設備

Publications (2)

Publication Number Publication Date
TWI725611B true TWI725611B (zh) 2021-04-21
TW202118995A TW202118995A (zh) 2021-05-16

Family

ID=75899249

Family Applications (1)

Application Number Title Priority Date Filing Date
TW108140974A TWI725611B (zh) 2019-11-12 2019-11-12 高爾夫球場自駕車輛之車輛導航切換設備

Country Status (4)

Country Link
JP (1) JP7209367B2 (zh)
KR (1) KR102373825B1 (zh)
CN (1) CN112859107B (zh)
TW (1) TWI725611B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220137627A1 (en) * 2020-11-05 2022-05-05 Panasonic Corporation Self-position estimation apparatus and mobile object

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20230081416A (ko) * 2021-11-30 2023-06-07 주식회사 에스제이 테크 스마트 골프카트 시스템
TWI824773B (zh) * 2022-10-14 2023-12-01 財團法人車輛研究測試中心 自駕車之路徑規劃系統及方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9465388B1 (en) * 2014-03-03 2016-10-11 Google Inc. Remote assistance for an autonomous vehicle in low confidence situations
TWI604980B (zh) * 2016-11-24 2017-11-11 國立臺北科技大學 載具控制系統及載具控制方法
US20190042859A1 (en) * 2017-08-02 2019-02-07 X Development Llc Systems and Methods for Determining Path Confidence for Unmanned Vehicles
TW201913599A (zh) * 2017-08-17 2019-04-01 崑山科技大學 用於車輛駕駛的自動化教練系統及方法
TWI674984B (zh) * 2018-11-15 2019-10-21 財團法人車輛研究測試中心 自動駕駛車輛之行駛軌跡規劃系統及方法
CN110379193A (zh) * 2019-07-08 2019-10-25 华为技术有限公司 自动驾驶车辆的行为规划方法及行为规划装置
TW202043704A (zh) * 2019-05-15 2020-12-01 宜陞有限公司 自駕車輛之車輛導航設備

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6246960B1 (en) * 1998-11-06 2001-06-12 Ching-Fang Lin Enhanced integrated positioning method and system thereof for vehicle
AU2001238480A1 (en) * 2000-02-15 2001-08-27 Prolink, Inc. Map-matching golf navigation system
JP2003265663A (ja) 2002-03-19 2003-09-24 Sanyo Electric Co Ltd 自走車両
JP2004138517A (ja) 2002-10-18 2004-05-13 Toyota Motor Corp 車載ナビゲーション装置
CN100580689C (zh) * 2005-01-04 2010-01-13 迪尔公司 使用基于视觉的调整引导车辆的方法和系统
TWI522258B (zh) * 2013-07-08 2016-02-21 Kang Li Based on electronic map, global navigation satellite system and vehicle motion detection technology Lane identification method
KR101625486B1 (ko) * 2014-11-14 2016-05-30 재단법인대구경북과학기술원 지도 기반 측위 시스템 및 그 방법
CN109249808A (zh) * 2015-03-21 2019-01-22 董润 采用导航系统和制动电能回收子系统的车辆
CN105783936B (zh) * 2016-03-08 2019-09-24 武汉中海庭数据技术有限公司 用于自动驾驶中的道路标识制图及车辆定位方法及系统
CN106441319B (zh) * 2016-09-23 2019-07-16 中国科学院合肥物质科学研究院 一种无人驾驶车辆车道级导航地图的生成系统及方法
JP6962007B2 (ja) * 2017-06-02 2021-11-05 村田機械株式会社 自律走行台車の走行制御装置、自律走行台車

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9465388B1 (en) * 2014-03-03 2016-10-11 Google Inc. Remote assistance for an autonomous vehicle in low confidence situations
TWI604980B (zh) * 2016-11-24 2017-11-11 國立臺北科技大學 載具控制系統及載具控制方法
US20190042859A1 (en) * 2017-08-02 2019-02-07 X Development Llc Systems and Methods for Determining Path Confidence for Unmanned Vehicles
TW201913599A (zh) * 2017-08-17 2019-04-01 崑山科技大學 用於車輛駕駛的自動化教練系統及方法
TWI674984B (zh) * 2018-11-15 2019-10-21 財團法人車輛研究測試中心 自動駕駛車輛之行駛軌跡規劃系統及方法
TW202043704A (zh) * 2019-05-15 2020-12-01 宜陞有限公司 自駕車輛之車輛導航設備
CN110379193A (zh) * 2019-07-08 2019-10-25 华为技术有限公司 自动驾驶车辆的行为规划方法及行为规划装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220137627A1 (en) * 2020-11-05 2022-05-05 Panasonic Corporation Self-position estimation apparatus and mobile object

Also Published As

Publication number Publication date
JP7209367B2 (ja) 2023-01-20
CN112859107B (zh) 2023-11-24
CN112859107A (zh) 2021-05-28
KR20210058640A (ko) 2021-05-24
JP2021076584A (ja) 2021-05-20
TW202118995A (zh) 2021-05-16
KR102373825B1 (ko) 2022-03-14

Similar Documents

Publication Publication Date Title
JP7209601B2 (ja) 高精度地図生成方法、高精度地図生成装置、コンピュータ機器、非一時的なコンピュータ読み取り可能な記憶媒体及びコンピュータプログラム
US20210311490A1 (en) Crowdsourcing a sparse map for autonomous vehicle navigation
US20210311486A1 (en) Navigation by augmented path prediction
JP7432285B2 (ja) レーンマッピング及びナビゲーション
US10118614B2 (en) Detailed map format for autonomous driving
US9921585B2 (en) Detailed map format for autonomous driving
US11474532B2 (en) Systems and methods for detecting anomalies in a vehicle system
Schreiber et al. Laneloc: Lane marking based localization using highly accurate maps
TWI725611B (zh) 高爾夫球場自駕車輛之車輛導航切換設備
CN112074885A (zh) 车道标志定位
TWI711804B (zh) 自駕車輛之車輛導航設備
KR102425735B1 (ko) 로드뷰 또는 항공뷰 맵 정보를 이용한 자율주행 방법 및 그 시스템
CN108628324A (zh) 基于矢量地图的无人车导航方法、装置、设备及存储介质
US11754415B2 (en) Sensor localization from external source data
CN109375629A (zh) 一种巡逻车及其导航避障方法
JP7321035B2 (ja) 物体位置検出方法及び物体位置検出装置
Luettel et al. Autonomous offroad navigation under poor GPS conditions
JP2022152736A (ja) 車両制御装置、車両制御方法及び車両制御用コンピュータプログラム
Gu et al. Correction of vehicle positioning error using 3D-map-GNSS and vision-based road marking detection
Nastro Position and orientation data requirements for precise autonomous vehicle navigation
US20240067211A1 (en) Method and apparatus for operating a vehicle for highly automated driving, and vehicle for highly automated driving
EP4160153A1 (en) Methods and systems for estimating lanes for a vehicle
CN109964132A (zh) 用于在运动物体上配置传感器的方法、设备和系统
Heidarsson et al. Active online calibration of multiple sensors for autonomous surface vessels
Tahir Development of an Autonomous Vehicle Platform