TW202115616A

TW202115616A - 應用路側特徵辨識之圖資定位系統及方法

Info

Publication number: TW202115616A
Application number: TW108136273A
Authority: TW
Inventors: 莊嶸騰
Original assignee: 財團法人車輛研究測試中心
Priority date: 2019-10-07
Filing date: 2019-10-07
Publication date: 2021-04-16

Abstract

本發明提供一種應用路側特徵辨識之圖資定位系統及方法，藉由俯視道路進行量測，建置一道路影像地圖，其中包括複數特徵點；及偵測移動載具行進時周圍之行駛環境，得到一點雲圖，從中辨識是否包含該些特徵點，並將動態物件濾除，再依據道路影像地圖、點雲圖中剩餘之特徵點及設定複數路側特徵點之特徵屬性，建置一定位圖資；當一移動載具行駛時，其根據定位圖資判斷出前方之至少二個路側特徵點，並做為參考點計算一移動載具航向角度，再藉以計算出移動載具之位置。本發明所建置之定位圖資具有低資料量、低運算複雜度及高可靠度等優點，可供自動駕駛移動載具估測出高精度的位置。

Description

應用路側特徵辨識之圖資定位系統及方法

本發明係有關一種定位技術，特別是指一種應用路側特徵辨識之圖資定位系統及方法。

自動駕駛車輛(簡稱自駕車)又稱為無人駕駛車輛，不需要人為操作即能感測周圍環境及導航，能以雷達、光學雷達、衛星導航及電腦視覺等技術感測周圍環境。先進的控制系統能將感測資料轉換成適當的導航道路、障礙物及相關標誌。

常見的自駕車的定位方法包括三角定位法、同步定位與地圖建構(Simultaneous Localization and Mapping, SLAM)定位法、標籤(Tag)定位法及基於指紋的地圖定位法(Fingerprint Based Map)。其中，三角定位法需要量測目標物及三個已知位置參考點的距離，求出以三個參考點為圓心的圓形的交會點，但其缺點是需要三個以上的參考點，且無航向資訊，定位精度較低；同步定位與地圖建構定位法係以光達掃描行駛路徑點雲圖，再以點雲比對手法去估測車輛位置，然而，建立點雲圖相當耗時，且資料量大，每1公里約需150MB的資料量，且在點雲特徵少的環境會無法定位，更需要透過差分全球定位系統(DGPS)與車輛轉向動態模型去修正車輛絕對航向；標籤定位法係利用三角函數的原理，以光學雷達掃描已知點的標籤，再反推車輛位置，例如已知公車站牌的座標為(x, y)，車輛與公車站牌的距離為d，夾角為θ，則車輛的位置為(x-dsinθ, y-dcosθ)，但此技術同樣需要透過差分全球定位系統(DGPS)與車輛轉向動態模型去修正車輛絕對航向，且標籤佈建不易，容易被路樹、行人或其他障礙物遮蔽；基於指紋的地圖定位法係先由第一輛車以光學雷達掃描行駛路徑點雲圖，第二輛車比對點雲圖以估測車輛位置，但建立點雲圖耗時，雖然資料量較同步定位與地圖建構定位法少，但資料須一格一格的經過編碼計算，運算量較大，且在點雲特徵少的環境下也具有無法定位的問題。

因此，本發明即提出一種應用路側特徵辨識之圖資定位系統及方法，有效解決上述該等問題，具體架構及其實施方式將詳述於下：

本發明之主要目的在提供一種應用路側特徵辨識之圖資定位系統及方法，其分別從道路上方取得俯視道路的道路影像地圖，及從平面取得行駛環境的點雲圖，利用資訊空間疊套之技術，從該道路影像地圖中快速區分出道路空間及路側空間，並取得特定物體類別之空間資訊，以將不需要的動態物件濾除，保留可做為路側特徵點的靜態物件，建立精度高而資料量小的定位圖資。

本發明之另一目的在提供一種應用路側特徵辨識之圖資定位系統及方法，其利用空拍機取得道路影像地圖，藉由解析度高的照相機，僅需低成本空拍圖，便可取得高精度的道路地圖。

本發明之再一目的在提供一種應用路側特徵辨識之圖資定位系統及方法，其進一步利用路側特徵點做為參考點以計算移動載具之航向角度，更精確地定位出移動載具的位置。

為達上述目的，本發明提供一種應用路側特徵辨識之圖資定位方法，包括：利用至少一第一偵測器俯視道路進行量測，建置一道路影像地圖，該道路影像地圖中包括複數特徵點；將至少一第二偵測器安裝於至少一移動載具上，偵測該移動載具行進時周圍之行駛環境得到一點雲圖，辨識其中是否包含該等特徵點，並將該等特徵點中之至少一動態物件濾除，依據該道路影像地圖、該點雲圖中剩餘之該等特徵點及設定複數路側特徵點之特徵屬性，以建置一定位圖資；將該定位圖資儲存於一移動載具中，當該移動載具行駛時，利用該移動載具中之一圖資定位系統掃描前方道路，並根據該定位圖資判斷出前方之至少二該路側特徵點，並做為參考點計算一移動載具航向角度；以及利用該移動載具航向角度及該至少二參考點，計算該移動載具之位置。

依據本發明之實施例，該定位圖資之建置方法更包括下列步驟：將該道路影像地圖與該點雲圖疊合，以辨識出一道路空間及至少一路側空間；將該等特徵點中之該等動態物件濾除，保留複數靜態物件做為該等路側特徵點；設定該等路側特徵點之該等特徵屬性；以及依據該道路影像地圖及該點雲圖之一疊合圖、該等路側特徵點及該等特徵屬性，建置該定位圖資。

承上，該路側空間係由內而外將人行道、腳踏車專用道及/或騎樓分為第一、第二路側空間。該特徵屬性包括經緯度座標、形狀、大小、高度等。

依據本發明之實施例，該移動載具於行駛中擷取路側影像，從中辨識出至少一目標物，並藉由該定位圖資中之該等特徵屬性判斷該目標物是否為該路側特徵點。

本發明另提供一種圖資定位系統，其裝設於一移動載具之一車上系統中，利用上述方法所建置之該定位圖資進行移動載具定位，該圖資定位系統包括：一資料庫，儲存該定位圖資，該定位圖資中包括複數路側特徵點及該等路側特徵點之複數特徵屬性；一路側特徵辨識模組，根據該定位圖資，掃描道路前方並判斷出符合該等特徵屬性之至少二該路側特徵點；一移動載具航向角度估測模組，利用至少二該路側特徵點做為參考點，計算該移動載具之一移動載具航向角度；以及一移動載具位置估算模組，利用該移動載具航向角度及該至少二參考點，計算該移動載具之位置。

本發明提供一種應用路側特徵辨識之圖資定位系統及方法，其從空中擷取高精度的道路影像地圖，再疊套至移動載具行駛周圍的點雲圖中，快速定位出道路與路側之區域，並將影像中的動態物件和靜態物件進行分類，刪除動態物件而僅保留靜態物件，不但可大幅降低定位圖資的資料量，且只需二個參考點便可計算出位置，不須採用三角定位法，運算複雜度也大幅降低，應用在自動駕駛的移動載具定位上，精準度可達到公分，相較於一般衛星定位的精準度即使誤差1~2公尺仍在可接受範圍，本發明之圖資定位方法顯然可確保自動駕駛車的精準度及安全性。

請參考第1圖，其為本發明應用路側特徵辨識之圖資定位方法之流程圖，主要包括四大步驟，步驟S10先建置定位圖資以供移動載具(如自動駕駛車輛)使用；步驟S12係當移動載具實際行駛時，辨識路側特徵點；步驟S14開始進行移動載具位置的修正，估測移動載具航向角度，步驟S16再計算出移動載具的位置。詳細流程詳述如後。

第2圖為本發明中建置定位圖資之細部流程圖。首先，步驟S102從道路的上方利用至少一第一偵測器俯視道路進行量測，建置一道路影像地圖，此第一偵測器可為裝有影像擷取裝置的飛行器，如空拍機、無人機、遙控飛機等，影像擷取裝置為相機或攝影機，只要在飛行器上安裝具有高解析度的影像擷取裝置便可擷取高精度的影像，因此道路影像地圖中包括複數特徵點，如車輛、行人等動態物件及紅綠燈、站牌、招牌、建築物、交通標誌等靜態物件，其中，動態物件之判斷係先預設道路空間上的車輛及路側空間上的行人及移動物件為動態物件，並將道路影像地圖中的車輛及行人等刪除；步驟S104將至少一第二偵測器安裝於至少一移動載具上，第二偵測器可為光學雷達(Lidar)或攝影機，攝影機可利用立體影像技術產生三維影像，而移動載具可為汽車，在移動載具移動時，第二偵測器偵測該移動載具周圍之行駛環境，針對掃描到的物體表面建立點雲，這些點雲用來表現物體的表面形狀，愈高密度的點雲可以建立更精確的模型，得到有深度的、三維的點雲圖(point cloud)，其包含的資訊為物體的幾何資訊，辨識其中是否包含該等特徵點；接著如步驟S106所述，將道路影像地圖與點雲圖利用資訊空間疊套之方式疊合，以辨識分類出道路空間和路側空間，路側空間之定義較為廣泛，可由內而外將人行道、腳踏車專用道及/或騎樓分為第一、第二路側空間；步驟S107中，將特徵點中之動態物件濾除，僅保留靜態物件做為路側特徵點，步驟S108設定複數路側特徵點的特徵屬性，包括路側特徵點的經緯度座標、形狀、大小、高度等，最後，在步驟S109中依據道路影像地圖及點雲圖之疊合圖、圖中剩餘之路側特徵點(靜態物件)及路側特徵點之特徵屬性，以建置一定位圖資。

當路側空間上沒有任何靜態物件時，代表沒有路側特徵點，則可直接將該路側空間刪除，只剩餘道路空間，如此將更減少定位圖資的資料量。

請參考第3A圖至第3D圖，其為本發明中定位圖資建立之流程示意圖。第3A圖為本發明中從上拍攝之高精度道路影像地圖，從上方可看出哪些部份是道路，哪些部份不是道路(如建築物、公園、停車場等)，第3B圖為由移動載具偵測描繪之3D點雲圖透過移動載具位置與高精度道路幾何空間資訊，從中可辨識出道路、車輛、行人、建築物、紅綠燈、站牌、招牌、交通標誌等特徵點；將第3B圖之點雲圖疊套至第3A圖之道路影像地圖後，可得到第3C圖之疊合圖，並在疊合圖上分類出道路空間10和至少一路側空間12、14，例如第一路側空間12可為腳踏車專用道，第二路側空間14為人行道，或是第一路側空間12為人行道，第二路側空間14為騎樓和建築物，在製作定位圖資時，由於車輛、行人等動態物件無法做為路側特徵點，因此將其刪除，若第二路側空間14無任何靜態物件時，此路側空間亦可以刪除之。最後建立出之定位圖資如第3D圖所示，在道路空間上之路側特徵點包括紅綠燈，而路側空間的路側特徵點包括建築物、電塔等地標及交通標誌，但此僅為一個實施例，舉凡有特點的、可做為地標或特徵點的物件皆可做為路側特徵點，如便利商店或速食店的招牌、加油站的招牌等。

路側特徵點的特徵屬性會依據不同的物件而設置，例如紅路燈的大小、高度和形狀、公車站牌的大小、高度和形狀、店家招牌的大小、高度和形狀等，一一記錄在定位圖資中。

當建立完成定位圖資後，其會儲存於雲端平台或移動載具的一圖資定位系統中，圖資定位系統並可定期從雲端更新最新的資訊。此圖資定位系統可設於移動載具之一車上系統中，運算後輸出移動載具之位置資訊。如第4圖所示，其為本發明圖資定位系統22之架構圖，包括一資料庫222、一路側特徵辨識模組224、一移動載具航向角度估測模組226及一移動載具位置估算模組228，其中資料庫222儲存定位圖資，定位圖資中包括複數路側特徵點及路側特徵點之複數特徵屬性；移動載具上所設置之環境感測裝置20會掃描前方道路，將掃描結果傳送給路側特徵辨識模組224，路側特徵辨識模組224再根據定位圖資，判斷掃描的影像中是否有符合特徵屬性之特徵點，若有至少二個符合的路側特徵點，則將其做為參考點；移動載具航向角度估測模組226利用參考點計算移動載具之一移動載具航向角度；移動載具位置估算模組228再利用移動載具航向角度及參考點計算出移動載具之位置。

在第1圖之步驟S12中，當移動載具行駛時辨識路側特徵之細部流程圖如第5圖所示，移動載具上裝設之環境感測裝置20可為相機、攝影機或光學雷達，於行駛中擷取路側影像，並利用車上系統的處理器利用影像辨識處理技術從中辨識出至少一目標物，並藉由定位圖資中之特徵屬性判斷該目標物是否為路側特徵點，其判斷方法包括：於步驟S122中判斷目標物是否符合路側特徵點的尺寸，若是，再接著於步驟S124判斷目標物是否符合路側特徵點的形狀，若是，再接著於步驟S126判斷目標物是否符合路側特徵點的高度，若是，則如步驟S128所述，此目標物符合某一個路側特徵點，例如紅綠燈；反之，若上述的判斷有任一者為否，則代表目標物不屬於任何一種路側特徵點，立即結束判斷，如步驟S129。

由於當移動載具之車頭方向與道路並非平行時，下一秒移動載具的位置會與直線前進的位置相距甚遠，因此本發明中為了精準定位，如第1圖之步驟S14所述更增加了計算移動載具航向角度之技術，而第6圖為本發明中計算移動載具航向角度及位置之示意圖。當移動載具行駛時，其車上系統的處理器根據定位圖資判斷出前方之至少二路側特徵點，並做為參考點計算一移動載具航向角度。假設移動載具的座標為(x_v ,y_v )，路側特徵點之座標為(x₁ ,y₁ )，則

其中，

，

。同理，給予另一個路側特徵點的座標為(x₀ ,y₀ )，則移動載具的座標計算如下：

由於

且

，綜合上式後可描述為

，其中

，

，且

因此可得到

。

上述

且

的等式後會先解出

，便可得到車頭與直線前進的夾角，即為移動載具航向角度。藉由此計算方法，只需二個路側特徵點做為參考點便可，無須如三角定位法需得到三個參考點才能計算移動載具位置。

接著進行第1圖步驟S16所述之計算移動載具位置。根據上述至少兩個參考點所推估出的至少兩個移動載具，計算移動載具之位置如下式：

，

綜上所述，本發明所提供之應用路側特徵辨識之圖資定位系統及方法係利用低成本的空拍圖，擷取高精度的道路影像地圖，與行進中擷取的周圍道路環境所製作的點雲圖進行資訊空間的疊合，以分類出道路空間和路側空間、動態物件和靜態物件，並將動態物件及空無一物的路側空間刪除，大幅減少資料量，且只需要二路側特徵點做為參考點就可以計算出移動載具的航向角度及位置，運算複雜度低但可靠度高，不使用衛星定位系統但精準度可達到公分為計，適用於自動駕駛車輛之導航定位。

唯以上所述者，僅為本發明之較佳實施例而已，並非用來限定本發明實施之範圍。故即凡依本發明申請範圍所述之特徵及精神所為之均等變化或修飾，均應包括於本發明之申請專利範圍內。

10:道路空間 12:第一路側空間 14:第二路側空間 20:環境感測裝置 22:圖資定位系統 222:資料庫 224:路側特徵辨識模組 226:移動載具航向角度估測模組 228:移動載具位置估算模組

第1圖為本發明應用路側特徵辨識之圖資定位方法之流程圖；第2圖為本發明中建立定位圖資之細部流程圖；第3A圖至第3D圖為定位圖資建立之流程示意圖；第4圖為本發明中圖資定位系統之方塊圖；第5圖為本發明中應用定位圖資辨識路側特徵點之流程圖；第6圖為本發明中計算移動載具航向角度及位置之示意圖。

Claims

一種應用路側特徵辨識之圖資定位方法，包括下列步驟：利用至少一第一偵測器俯視道路進行量測，建置一道路影像地圖，該道路影像地圖中包括複數特徵點；將至少一第二偵測器安裝於至少一移動載具上，偵測該移動載具行進時周圍之行駛環境得到一點雲圖，辨識其中是否包含該等特徵點，並將該等特徵點中之至少一動態物件濾除，依據該道路影像地圖、該點雲圖中剩餘之該等特徵點及設定複數路側特徵點之特徵屬性，以建置一定位圖資；將該定位圖資儲存於該移動載具中，當該移動載具行駛時，利用該移動載具中之一圖資定位系統掃描前方道路，並根據該定位圖資判斷出至少二該路側特徵點，並做為參考點計算一移動載具航向角度；以及利用該移動載具航向角度及該至少二參考點，計算該移動載具之位置。
如請求項1所述之應用路側特徵辨識之圖資定位方法，其中該第一偵測器為設有影像擷取裝置之飛行器。
如請求項2所述之應用路側特徵辨識之圖資定位方法，其中該飛行器為空拍機、無人機、遙控飛機等。
如請求項1所述之應用路側特徵辨識之圖資定位方法，其中該第二偵測器為光學雷達(Lidar)、雷射、相機或聲納等。
如請求項1所述之應用路側特徵辨識之圖資定位方法，其中該定位圖資之建置方法更包括下列步驟：將該道路影像地圖與該點雲圖疊合，以辨識出一道路空間及至少一路側空間；將該等特徵點中之該等動態物件濾除，保留複數靜態物件做為該等路側特徵點；設定該等路側特徵點之該等特徵屬性；以及依據該道路影像地圖及該點雲圖之一疊合圖、該等路側特徵點及該等特徵屬性，建置該定位圖資。
如請求項5所述之應用路側特徵辨識之圖資定位方法，其中該等特徵點包括車輛、行人等動態物件及紅綠燈、站牌、招牌、建築物、交通標誌等靜態物件。
如請求項5所述之應用路側特徵辨識之圖資定位方法，其中該路側空間係由內而外將人行道、腳踏車專用道及/或騎樓分為第一、第二路側空間。
如請求項5所述之應用路側特徵辨識之圖資定位方法，其中該特徵屬性包括經緯度座標、形狀、大小、高度等。
如請求項8所述之應用路側特徵辨識之圖資定位方法，其中該移動載具於行駛中擷取路側影像，從中辨識出至少一目標物，並藉由該定位圖資中之該等特徵屬性判斷該目標物是否為該路側特徵點。
如請求項1所述之應用路側特徵辨識之圖資定位方法，其中該定位圖資係儲存於一雲端平台或該移動載具之一圖資定位系統中，該圖資定位系統可設於該移動載具之一車上系統中。
一種圖資定位系統，其裝設於一移動載具之一車上系統中，利用請求項1所建置之該定位圖資進行移動載具定位，該圖資定位系統包括：一資料庫，儲存該定位圖資，該定位圖資中包括複數路側特徵點及該等路側特徵點之複數特徵屬性；一路側特徵辨識模組，根據該定位圖資，掃描道路前方並判斷出符合該等特徵屬性之至少二該路側特徵點；一移動載具航向角度估測模組，利用至少二該路側特徵點做為參考點，計算該移動載具之一移動載具航向角度；以及一移動載具位置估算模組，利用該移動載具航向角度及該至少二參考點，計算該移動載具之位置。
如請求項11所述之圖資定位系統，其中該等路側特徵點包括紅綠燈、站牌、招牌、建築物、交通標誌等靜態物件。
如請求項11所述之圖資定位系統，其中該等特徵屬性包括經緯度座標、形狀、大小、高度等。
如請求項11所述之圖資定位系統，其中該移動載具包括一環境感測裝置，用以掃描前方道路影像。
如請求項14所述之圖資定位系統，其中該環境感測裝置為相機、攝影機或光學雷達。