TWI722652B

TWI722652B - 自動駕駛協控系統與控制方法

Info

Publication number: TWI722652B
Application number: TW108141483A
Authority: TW
Inventors: 張偉鉉; 莊嶸騰
Original assignee: 財團法人車輛研究測試中心
Priority date: 2019-11-15
Filing date: 2019-11-15
Publication date: 2021-03-21
Also published as: TW202120363A

Abstract

一種自動駕駛協控系統與控制方法，供應用在全自動駕駛車隊，該自動駕駛協控系統包含一前導車控制裝置、至少一後車控制裝置與一伺服器，該前導車控制裝置設置於一前導車，該後車控制裝置設置於一後車；該前導車控制裝置與該後車控制裝置彼此連線，該伺服器也與該前導車控制裝置與該後車控制裝置建立連線；藉此，該前導車控制裝置、該後車控制裝置與該伺服器可彼此流通行車資訊，達成協控(Coordination)的功效。

Description

自動駕駛協控系統與控制方法

本發明有關一種協控系統與控制方法，特別是指自動駕駛協控系統與控制方法。

基於大量運輸需求，例如在兩地之間接駁載客，業者可利用複數車輛組成車隊進行運輸，該等車輛朝著相同目的地前進。一般來說，車隊包含一輛前導車以及一輛或多輛後車，該前導車為車隊的首輛車，後車係跟隨在前導車後方。傳統上，前導車及後車均是由司機駕駛車輛，但隨著人力成本不斷提高，業者想到將電腦逐漸取代後車的司機，亦即後車改採電腦自動駕駛，後車的電腦僅需進行跟車的動作，前導車仍是由司機駕駛。如此一來，因為後車司機已被電腦取代，故整體來看，業者可節省司機人力成本。

然而，如何將運輸成本最小化是業者不斷追求的目標，故仍有待進一步提出更佳解決方案的必要性。

本發明的主要目的是提供一種自動駕駛協控系統，期以高階自駕車搭配低階自駕車組成車隊運行，可採較低的運行成本進行車隊的運作，並可應用於大眾接駁運輸或商業碼頭運貨。

本發明自動駕駛協控系統供應用在一全自動駕駛車隊，該全自動駕駛車隊包含一前導車與一後車，該前導車沿著一指定行車路線前進，該後車跟隨在該前導車後方，該自動駕駛協控系統包含：一前導車控制裝置，設置於該前導車且包含：一進階型行車資訊收集單元；一前導車通訊單元，包含一車間通訊模組與一行動通訊模組；及一前導車決策控制單元，電性連接該進階型行車資訊收集單元與該前導車通訊單元；一後車控制裝置，設置於該後車且包含：一精簡型行車資訊收集單元；一後車通訊單元，包含一車間通訊模組與一行動通訊模組，該後車通訊單元的車間通訊模組連線該前導車通訊單元的車間通訊模組以供進行雙向資料傳輸；及一後車決策控制單元，電性連接該精簡型行車資訊收集單元與該後車通訊單元；以及一伺服器，連線該前導車通訊單元的行動通訊模組與該後車通訊單元的行動通訊模組以供分別進行雙向資料傳輸。

本發明的另一目的是提供一種如前所述自動駕駛協控系統的控制方法，包含：該前導車決策控制單元接收一後車行車資訊，該後車決策控制單元接收一前導車行車資訊，該伺服器接收該後車行車資訊以及該前導車行車資訊；該後車決策控制單元根據該前導車行車資訊進行該後車的車輛控制。

根據本發明的自動駕駛協控系統與方法，藉由前導車控制裝置、後車控制裝置與伺服器彼此流通行車資訊，達成協控(Coordination)的功效，讓車隊成為全自動駕駛車隊，故可降低人力成本；另一方面，因為該後車控制裝置採用較低成本的精簡型行車資訊收集單元，故讓車隊中的後車可基於較低的運行成本進行跟車。

本發明自動駕駛協控系統可供應用在一全自動駕駛車隊，請參考圖1，該全自動駕駛車隊包含一前導車10與至少一後車，圖1以兩輛後車為例，其分別為一第一後車11與一第二後車12，該前導車10與所述後車11、12沿著一指定行車路線前進，第一後車11跟隨在前導車10後方，第二後車12跟隨在第一後車11後方，本發明例如可在較單純及受控制的道路環境下進行系統全自動駕車，例如可供應用於大眾接駁運輸或商業碼頭運貨。需說明的是，採用系統全自動駕駛的前導車10與後車11、12又稱無人車(unmanned car)，亦即前導車10與後車11、12都是採系統全自動駕駛的車輛，人類司機並無涉入前導車10與後車11、12的駕駛。

請參考圖1與圖2，本發明自動駕駛協控系統的實施例包含一前導車控制裝置20、至少一後車控制裝置30與一伺服器40，前導車控制裝置20設置於前導車10，後車控制裝置30設置於所述後車11、12，即每一輛後車11、12皆配備有後車控制裝置30，伺服器40為設置在機房或辦公室的遠端伺服器或雲端伺服器，可由該伺服器40設定該指定行車路線，並可監視與控制全自動駕駛車隊的行車狀況。

該前導車控制裝置20包含一進階型行車資訊收集單元21、一前導車通訊單元22與一前導車決策控制單元23；該前導車通訊單元22包含一車間通訊模組221與一行動通訊模組222；該前導車決策控制單元23可為電子控制單元(Electronic Control Unit, ECU)，其電性連接該進階型行車資訊收集單元21與該前導車通訊單元22。該後車控制裝置30包含一精簡型行車資訊收集單元31、一後車通訊單元32與一後車決策控制單元33；該後車通訊單元32包含一車間通訊模組321與一行動通訊模組322；該後車通訊單元32的車間通訊模組321無線連線該前導車通訊單元22的車間通訊模組221以供進行雙向資料傳輸，其中，所述車間通訊模組221、321可為專用短程通訊模組(Dedicated Short Range Communications, DSRC)，或於其他實施例中，各通訊模組221、321之間可透過第四代行動通訊技術(4G)、第五代行動通訊技術(5G)或更進階的次世代行動通訊技術彼此直接或間接地連線；該後車決策控制單元33可為電子控制單元(ECU)，其電性連接該精簡型行車資訊收集單元31與該後車通訊單元32。該伺服器40連線該前導車通訊單元22的行動通訊模組222與該後車通訊單元32的行動通訊模組322以供分別進行雙向資料傳輸。

該前導車通訊單元22的行動通訊模組222與該後車通訊單元32的行動通訊模組322可透過第四代行動通訊技術(4G)、第五代行動通訊技術(5G)或更進階的次世代行動通訊技術連線到網際網路，例如各行動通訊模組222、322可安裝電信業者提供的用戶識別模組卡(Subscriber Identity Module card, SIM card)以連線至網際網路，通過網際網路與該伺服器40建立連線。

是以，前導車控制裝置20與後車控制裝置30彼此連線，該伺服器40也與前導車控制裝置20與後車控制裝置30建立連線，藉由前導車控制裝置20、後車控制裝置30與伺服器40彼此流通行車資訊，前導車控制裝置20與後車控制裝置30傳遞資訊的時間間隔可為數百毫秒，達成協控(Coordination)的功效，可基於較低的運行成本讓行車更為順暢、舒適、安全。

請參考圖3，該進階型行車資訊收集單元21可包含三維光學雷達(Three-Dimensional Light Detection And Ranging, 3-D LiDAR)211、二維光學雷達(2-D LiDAR)212、攝影機213、即時動態定位(Real-Time Kinematic, RTK)模組214與慣性量測模組(Inertial Measurement Unit, IMU)215。所述三維光學雷達211可安裝在前導車10車頂，所述二維光學雷達212可安裝在前導車10的四周圍，所述攝影機213可安裝在前導車10車內或車外，藉由三維光學雷達211、二維光學雷達212與攝影機213朝前方、側向或後方進行周遭環境的偵測，並將偵測到的周遭環境資訊216提供給前導車決策控制單元23。該即時動態定位模組214可定位出前導車10的絕對定位座標並提供給該前導車決策控制單元23，另外，該慣性量測模組215包含陀螺儀和加速度計，可供測量前導車10的姿態(attitude)並提供給前導車決策控制單元23，供該前導車決策控制單元23結合絕對定位座標與姿態得到前導車10的絕對定位資訊217。該前導車決策控制單元23可儲存一圖資資訊218，該圖資資訊218可以是透過行動通訊模組222從該伺服器40下載的。該前導車決策控制單元23可電性連接前導車10的車上診斷系統(On-Board Diagnostics, OBD)或控制器區域網路匯流排(Controller Area Network Bus, CAN Bus)以擷取車輛動態資訊219，例如車速、方向盤轉角、車距或加速度等。

該伺服器40可傳送一指定行車路線給該前導車決策控制單元23，由該前導車決策控制單元23根據該指定行車路線前往一目的地。其中，該前導車決策控制單元23可根據如前所述的周遭環境資訊216、絕對定位資訊217與圖資資訊218判斷前導車10是否行駛於該指定行車路線上。

在該後車控制裝置30中，將其精簡型行車資訊收集單元31與該進階型行車資訊收集單元21相比，該進階型行車資訊收集單元21的組成與功能比該精簡型行車資訊收集單元31更高階，故該精簡型行車資訊收集單元31的製造成本及價格會比該進階型行車資訊收集單元21更低。舉例來說，該精簡型行車資訊收集單元31所包含的元件相對較少或功能較簡單，例如包含二維光學雷達311、攝影機312、低成本即時動態定位模組313與慣性量測模組314當中的四個或四個以下，其中，和該進階型行車資訊收集單元21的即時動態定位模組214相比，該低成本即時動態定位模組313的價格更低且功能較為低階。

本發明的實施例中，請參考圖4，該精簡型行車資訊收集單元31包含二維光學雷達311、攝影機312、低成本即時動態定位模組313與慣性量測模組314，該二維光學雷達311可設置在第一後車11之最佳感測效果處，如四周處以朝向該前導車10的車尾進行偵測，同樣的，第二後車12之最佳感測效果處，如四周處亦可設置二維光學雷達311以朝向第一後車11的車尾進行偵測。該二維光學雷達311結合攝影機312可產生周遭環境資訊315供後車決策控制單元33接收，該低成本即時動態定位模組313與慣性量測模組314可供後車決策控制單元33判斷一相對定位資訊316，舉例來說，該低成本即時動態定位模組313可產生第一後車11的定位座標，該慣性量測模組314測量第一後車11的姿態(attitude)，該後車決策控制單元33可通過其車間通訊模組321或行動通訊模組322接收前導車10的絕對定位資訊217，將前導車的10的絕對定位資訊217與第一後車11的定位座標及姿態進行比對即可得到相對定位資訊316，此外，該二維光學雷達311產生的座標資訊也可用以判斷該相對定位資訊316(容後說明)。該後車決策控制單元33可接收一圖資資訊317，該圖資資訊317可以是從前導車決策控制單元23或伺服器40接收的。且該後車決策控制單元33可電性連接第一後車11的車上診斷系統(On-Board Diagnostics, OBD)或控制器區域網路匯流排(Controller Area Network Bus, CAN Bus)以擷取車輛動態資訊318，例如車速、方向盤轉角、車距或加速度等。

前述已說明該前導車決策控制單元23所收集的前導車行車資訊(即：周遭環境資訊216、絕對定位資訊217、圖資資訊218與車輛動態資訊219)，此外，該前導車決策控制單元23可將所述前導車行車資訊分享給後車決策控制單元33與伺服器40；其中，每一筆分享的前導車行車資訊夾帶一前導車本地時間。如此一來，後車決策控制單元33與伺服器40可得到前導車10之行車資訊所對應的時間點，後車決策控制單元33可計算資訊傳遞時間差(即：後車本地時間減去所接收前導車10之行車資訊所對應的前車本地時間)，作為決策控制的依據。需說明的是，同一時間前導車本地時間與後車本地時間是同步的。同理，後車決策控制單元33可將後車行車資訊夾帶後車本地時間分享給前導車決策控制單元23與伺服器40，前車決策控制單元23可計算資訊傳遞時間差。

是以，請參考圖5所示該前導車決策控制單元23的決策控制流程示意圖，先執行車資訊的收集與判斷(步驟S01)，收集的行車資訊可包含前導車10的周遭環境資訊216、絕對定位資訊217、圖資資訊218、車輛動態資訊219與後車行車資訊300；當判斷為正常資訊(步驟S02)或異常資訊(步驟S03)，該前導車決策控制單元23執行控制策略判斷(步驟S04)，其中，當判斷有異常資訊時，在執行控制策略判斷時進一步執行異常處理(步驟S04')；於執行控制策略判斷後，進行前導車10的車輛控制(步驟S05)。

同理，請參考圖6所示該後車決策控制單元33的決策控制手段流程示意圖，先執行資訊的收集與判斷(步驟S11)，收集的行車資訊可包含第一後車11的周遭環境資訊315、車輛動態資訊318、圖資資訊317、相對定位資訊316與前導車行車資訊200；當判斷為正常資訊(步驟S12)或異常資訊(步驟S13)，該後車決策控制單元33執行控制策略判斷(步驟S14)，其中，當判斷有異常資訊時，在執行控制策略判斷時進一步執行異常處理(步驟S14')；於執行控制策略判斷後，進行第一後車11的車輛控制(步驟S14)。

以下透過範例說明該後車決策控制單元33所判斷的相對定位資訊316，請參考圖7所示的第一車13與第二車14，第二車14跟隨在第一車13後方，故第二車14為後車，第一車13可為前導車或另一後車，在此該第一車13為前導車為例。在第二車14配備有如前所述的後車控制裝置30，其精簡型行車資訊收集單元31的二維光學雷達311可朝向第一車13車尾進行偵測(包含後保險桿130)，以取得第二車14相對於第一車13車尾輪廓的相對座標，供後車決策控制單元33得到第一車13後保險桿130的左側座標131、右側座標132與中心座標133。第二車14的後車決策控制單元33可接收第一車13的絕對定位資訊217，故根據第一車13的絕對定位資訊217與所述中心座標133進行座標換運算也可得到第二車14相對於第一車13的相對定位資訊316。

另一方面，該後車決策控制單元33可根據所述座標131、132、133估算第一車13輪廓的變化量來判斷第一車13是否有轉彎的動作。利用第二車14的相對定位資訊316與所述左側座標131可估算第二車14至第一車13後保險桿130左側之間的第一距離L1，利用第二車14的相對定位資訊316與所述右側座標132可估算第二車14至第一車13後保險桿130右側之間的第二距離L2，利用第二車14的相對定位資訊316與所述中心座標133可得到第一車13與第二車14之間的第三距離L3。

若該第二車14的後車決策控制單元33判斷出第一距離L1等於第二距離L2，代表第二車14與第一車13保持直行；若判斷出第一距離L1相異於第二距離L2，代表第一車13正在轉向。舉例來說，請參考圖8，第一距離L1與第二距離L2的變化量與第一車13的轉向角度β直接相關，當第一距離L1大於第二距離L2，代表第一車13向右轉，第二車14的後車決策控制單元33即可得知第二車14與第一車13的相對動態，據此進行對應的車輛控制。藉此，供後車僅利用低成本的精簡型行車資訊收集單元31達到有效率的跟車動作。

請參考圖2與圖9，雖然該前導車決策控制單元23根據指定行車路線A控制前導車10前進，但實際上前導車10行駛的過程中會有物理偏差量，故前導車10的實際行車路線B與指定行車路線A存在誤差Δd。請參考圖10，該前導車決策控制單元23接收絕對定位資訊217與指定行車路線A後(步驟S20)，判斷絕對定位資訊217與指定行車路線A的誤差Δd是否大於一前導車修正門檻值(步驟S21)，該前導車修正門檻值舉例來說可為1公尺。若是，該前導車決策控制單元23產生一前導車修正資訊，以根據該前導車修正資訊進行車輛控制(步驟S22)，舉例來說，可將絕對定位資訊217與指定行車路線A的座標相減，若相減結果為負值，可代表絕對定位資訊217相較於指定行車路線A偏右，該前導車決策控制單元23可控制前導車向左修正，該前導車修正資訊包含向左轉的轉向角度；相對的，若絕對定位資訊217相較於指定行車路線A偏左，該前導車決策控制單元23可控制前導車向右修正，此時該前導車修正資訊包含向右轉的轉向角度。此外，該前導車決策控制單元23也將前導車本地時間、前導車修正資訊、指定行車路線A與絕對定位資訊217傳送給後車決策控制單元33(步驟S23)。

請參考圖11，對於後車決策控制單元33來說，當後車決策控制單元33收到前導車本地時間、前導車修正資訊、指定行車路線A與絕對定位資訊217(步驟S30)，據此計算一後車修正資訊(步驟S31)，舉例來說，該後車決策控制單元33可將後車本地時間與接收到的前導車本地時間相減以得到一時間差，代表經過該時間差的時間長度後，該第一後車11需要位在一預計抵達位置，該預計抵達位置即為接收到的該絕對定位資訊217；此時，該後車決策控制單元33將該預計抵達位置與其圖資資訊317及指定行車路線A進行比對，進而產生該後車修正資訊，該後車修正資訊包含使該第一後車11從該相對位置資訊316移動到該預計抵達位置的轉向角度。產生該後車修正資訊後，判斷該後車修正資訊是否大於一後車修正門檻值(步驟S32)，該後車修正門檻值舉例來說可為10度；若是，根據該後車修正資訊進行車輛控制(步驟S33)；若否，則不修正後車當下的行車路線。藉此，如第一後車11是載客車輛，可避免第一後車11過度修正造成後車偏擺而引起乘客不適感。

綜上所述，本發明藉由前導車控制裝置20、後車控制裝置30與伺服器40彼此流通行車資訊，達成協控(Coordination)的功效，因為該後車控制裝置30採用較低成本的精簡型行車資訊收集單元31，故讓車隊中的後車可基於較低的運行成本進行跟車。

10:前導車11:第一後車 12:第二後車13:第一車 130:後保險桿131:左側座標 132:右側座標133:中心座標 14:第二車20:前導車控制裝置 200:前導車行車資訊21:進階型行車資訊收集單元 211:三維光學雷達212:二維光學雷達 213:攝影機214:即時動態定位模組 215:慣性量測模組216:周遭環境資訊 217:絕對定位資訊218:圖資資訊 219:車輛動態資訊22:前導車通訊單元 221:車間通訊模組222:行動通訊模組 23:前導車決策控制單元30:後車控制裝置 300:後車行車資訊31:精簡型行車資訊收集單元 311:二維光學雷達312:攝影機 313:低成本即時動態定位模組314:慣性量測模組 315:周遭環境資訊316:相對定位資訊 317:圖資資訊318:車輛動態資訊 32:後車通訊單元321:車間通訊模組 322:行動通訊模組33:後車決策控制單元 40:伺服器A:指定行車路線 B:實際行車路線β:轉向角度 A:指定行車路線B:實際行車路線 Δd:誤差

圖1：本發明協控系統應用在全自動駕駛車隊的示意圖。圖2：本發明協控系統的方塊示意圖。圖3：本發明的前導車控制裝置的方塊示意圖。圖4：本發明的後車控制裝置的方塊示意圖。圖5：本發明的前導車決策控制單元的決策控制流程示意圖。圖6：本發明的後車決策控制單元的決策控制流程示意圖。圖7：本發明的後車定位示意圖(一)。圖8：本發明的後車定位示意圖(二)。圖9：實際行車路線與指定行車路線存在誤差的示意圖。圖10：本發明的前導車決策控制單元的流程示意圖。圖11：本發明的後車決策控制單元的流程示意圖。

20:前導車控制裝置

21:進階型行車資訊收集單元

22:前導車通訊單元

221:車間通訊模組

222:行動通訊模組

23:前導車決策控制單元

30:後車控制裝置

31:精簡型行車資訊收集單元

32:後車通訊單元

321:車間通訊模組

322:行動通訊模組

33:後車決策控制單元

40:伺服器

Claims

一種自動駕駛協控系統，供應用在一全自動駕駛車隊，該全自動駕駛車隊包含一前導車與一後車，該前導車沿著一指定行車路線前進，該後車跟隨在該前導車後方，該自動駕駛協控系統包含：一前導車控制裝置，設置於該前導車且包含：一進階型行車資訊收集單元；一前導車通訊單元，包含一車間通訊模組與一行動通訊模組；及一前導車決策控制單元，電性連接該進階型行車資訊收集單元與該前導車通訊單元；一後車控制裝置，設置於該後車且包含：一精簡型行車資訊收集單元；一後車通訊單元，包含一車間通訊模組與一行動通訊模組，該後車通訊單元的車間通訊模組連線該前導車通訊單元的車間通訊模組以供進行雙向資料傳輸；及一後車決策控制單元，電性連接該精簡型行車資訊收集單元與該後車通訊單元；以及一伺服器，連線該前導車通訊單元的行動通訊模組與該後車通訊單元的行動通訊模組以供分別進行雙向資料傳輸；該前導車決策控制單元接收一後車行車資訊，該後車決策控制單元接收一前導車行車資訊，該伺服器接收該後車行車資訊以及該前導車行車資訊，該後車決策控制單元根據該前導車行車資訊進行該後車的車輛控制，其中：該精簡型行車資訊收集單元偵測該前導車之後保險桿的一左側座標、一右側座標與一中心座標以提供該後車決策控制單元；該進階型行車資訊收集單元提供該前導車的一絕對定位資訊，使該後車決策控制單元接收的該前導車行車資訊包含該絕對定位資訊；該後車決策控制單元根據該絕對定位資訊與該中心座標得到該後車的一相對定位資訊。
如請求項1所述之自動駕駛協控系統，該進階型行車資訊收集單元包含三維光學雷達、二維光學雷達、攝影機、即時動態定位模組與慣性量測模組；該精簡型行車資訊收集單元包含二維光學雷達、攝影機、低成本即時動態定位模組與慣性量測模組當中的四個或四個以下。
如請求項1所述之自動駕駛協控系統，該前導車通訊單元的車間通訊模組與該後車通訊單元的車間通訊模組為專用短程通訊模組(DSRC)。
如請求項1所述之自動駕駛協控系統，該前導車通訊單元的行動通訊模組與該後車通訊單元的行動通訊模組安裝電信業者提供的用戶識別模組卡以連線至網際網路，通過網際網路與該伺服器建立連線。
一種如請求項1所述之自動駕駛協控系統的控制方法，包含：由該精簡型行車資訊收集單元包含的二維光學雷達朝向該前導車的後保險桿進行偵測，使該後車決策控制單元得到該前導車之後保險桿的該左側座標、該右側座標與該中心座標。
如請求項5所述之自動駕駛協控系統的控制方法，該後車決策控制單元利用該相對定位資訊與該左側座標估算該後車至該前導車之後保險桿左側之間的一第一距離，利用該相對定位資訊與該右側座標估算該後車至該前導車之後保險桿右側之間的一第二距離；當該後車決策控制單元判斷出該第一距離相異於該第二距離，進行該後車的車輛控制。
如請求項5所述之自動駕駛協控系統的控制方法，該前導車決策控制單元判斷該絕對定位資訊與該指定行車路線的誤差量是否大於一前導車修正門檻值；若是，該前導車決策控制單元產生一前導車修正資訊，以根據該前導車修正資訊進行該前導車的車輛控制；該前導車決策控制單元將一前導車本地時間、該前導車修正資訊、該指定行車路線與該絕對定位資訊傳送給該後車決策控制單元。
如請求項7所述之自動駕駛協控系統的控制方法，該後車決策控制單元根據接收到的該前導車本地時間、該前導車修正資訊、該指定行車路線與該絕對定位資訊計算一後車修正資訊；該後車決策控制單元判斷該後車修正資訊是否大於一後車修正門檻值；若是，根據該後車修正資訊進行該後車的車輛控制。