TWI715221B - 自適應軌跡生成方法及系統 - Google Patents

自適應軌跡生成方法及系統 Download PDF

Info

Publication number
TWI715221B
TWI715221B TW108135235A TW108135235A TWI715221B TW I715221 B TWI715221 B TW I715221B TW 108135235 A TW108135235 A TW 108135235A TW 108135235 A TW108135235 A TW 108135235A TW I715221 B TWI715221 B TW I715221B
Authority
TW
Taiwan
Prior art keywords
vehicle
obstacle
information
distance
collision
Prior art date
Application number
TW108135235A
Other languages
English (en)
Other versions
TW202112593A (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 TW108135235A priority Critical patent/TWI715221B/zh
Application granted granted Critical
Publication of TWI715221B publication Critical patent/TWI715221B/zh
Publication of TW202112593A publication Critical patent/TW202112593A/zh

Links

Images

Landscapes

  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

一種自適應軌跡生成方法，適用於一車輛，由一車用電腦來實施，並包含：(A)根據一當前時間點的一相關於該車輛的車輛資訊、一車輛位置及至少一筆相關於該車輛相距一預定距離範圍內的至少一個障礙物的障礙物資訊，判定是否滿足一第一特定條件；(B)當判定出不滿足該第一特定條件時，根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置、一路況資訊，及該車流速度，判定是否滿足一第二特定條件；(C)當判定出滿足該第二特定條件時，根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置，及該路況資訊更新一當前軌跡路徑。

Description

自適應軌跡生成方法及系統
本發明是有關於一種軌跡生成方法，特別是指一種自適應軌跡生成方法及系統。
自動駕駛技術主要包括環境感知技術、導航定位技術、路徑規劃技術，以及決策控制技術等四個部分，其中路徑規劃是自動駕駛技術中十分關鍵的組成部分，其任務就是在具有障礙物的環境內按照一定的評價標準，尋找一條從起始狀態包括位置和姿態到達目標狀態的無碰撞路徑，即根據車輛的行駛車速以及環境狀況等訊息，規劃出一條可以使自動駕駛車輛安全平穩行駛的路徑。
然而，現有的自動駕駛汽車在規劃行駛軌跡後，無法臨時更改行駛軌跡，因此行車中途若道路環境改變而有危險時，自動駕駛汽車通常採取煞車，無法適時的做出閃避障礙物的動作，表示現有的自動駕駛汽車在原始行進軌跡受到外部環境影響變得不安全，無法及時脫離危險區域而有安全上的疑慮。
因此，本發明的目的，即在提供一種能因應周遭環境的改變自動更改適當的路徑的自適應軌跡生成方法。
於是，本發明自適應軌跡生成方法，適用於一車輛，該車輛設置有一系統，該系統包括一車輛感測裝置、一障礙物感測裝置、一導航裝置、一車流感測裝置，及一電連接該車輛感測裝置、該障礙物感測裝置、該導航裝置及該車流感測裝置的車用電腦，該車輛感測裝置用以持續偵測該車輛後產生一相關於該車輛的車輛資訊，該車輛資訊包括該車輛的一車輛速度及一車輛加速度，該障礙物感測裝置用以持續感測與該車輛相距一預定距離範圍內的至少一個障礙物，以產生對應於該至少一個障礙物的至少一筆障礙物資訊，每筆障礙物資訊包括所對應的障礙物的一障礙物位置、一障礙物移動速度，及一障礙物加速度，該導航裝置儲存有一相關於該車輛所行駛的路線的地圖，該地圖包括每一條道路所對應的車道數，該導航裝置用以持續定位該車輛的一車輛位置，並用以產生一路況資訊，該路況資訊包括一最高限速及一車道寬，該車流感測裝置15用以感測該車輛所在道路的多個同向車道的車流速度，該車用電腦儲存一當前軌跡路徑，該方法由該車用電腦來實施，並包含一步驟(A)、一步驟(B)，及一步驟(C)。
該步驟(A)中，該車用電腦根據一當前時間點的該車輛資訊、該車輛位置及該至少一筆障礙物資訊，判定是否滿足一第一特定條件。
該步驟(B)中，當該車用電腦判定出不滿足該第一特定條件時，該車用電腦根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置、該路況資訊，及該車流速度，判定是否滿足一第二特定條件。
該步驟(C)中，當該車用電腦判定出滿足該第二特定條件時，該車用電腦根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置，及該路況資訊更新該當前軌跡路徑。
本發明的另一目的，即在提供一種能因應周遭環境的改變自動更改適當的路徑的自適應軌跡生成系統。
於是，本發明自適應軌跡生成系統，適用於一車輛，包含一車輛感測裝置、一障礙物感測裝置、一導航裝置、一車流感測裝置，及一車用電腦。
該車輛感測裝置用以持續偵測該車輛後產生一相關於該車輛的車輛資訊，該車輛資訊包括該車輛的一車輛速度及一車輛加速度。
該障礙物感測裝置用以持續感測與該車輛相距一預定距離範圍內的至少一個障礙物，以產生對應於該至少一個障礙物的至少一筆障礙物資訊，每筆障礙物資訊包括所對應的障礙物的一障礙物位置、一障礙物移動速度，及一障礙物加速度。
該導航裝置儲存有一相關於該車輛所行駛的路線的地圖，該地圖包括每一條道路所對應的車道數，該導航裝置用以持續定位該車輛的一車輛位置，並用以產生一路況資訊，該路況資訊包括一最高限速及一車道寬。
該車流感測裝置用以感測該車輛所在道路的多個同向車道的車流速度。
該車用電腦電連接該車輛感測裝置、該障礙物感測裝置、該車流感測裝置，及該導航裝置，並儲存一當前軌跡路徑。
其中，該車用電腦根據一當前時間點的該車輛資訊、該車輛位置及該至少一筆障礙物資訊，判定是否滿足一第一特定條件，當該車用電腦判定出不滿足該第一特定條件時，該車用電腦根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置、該路況資訊，及該車流速度，判定是否滿足一第二特定條件，當該車用電腦判定出滿足該第二特定條件時，該車用電腦根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置，及該路況資訊更新該當前軌跡路徑。
本發明之功效在於：當該車用電腦判定出不滿足該第一特定條件且滿足該第二特定條件時，以判定出道路環境改變而有安全疑慮時，該車用電腦更新該當前軌跡路徑，以及時閃避障礙物。
參閱圖1，說明本發自適應軌跡生成系統之一實施例，該自適應軌跡生成系統1設置於一車輛(圖未示)，該自適應軌跡生成系統1包括一車輛感測裝置11、一障礙物感測裝置12、一導航裝置13、一車流感測裝置15、一路面摩擦力估測裝置16，及一車用電腦14。
該車輛感測裝置11用以持續偵測該車輛後產生一相關於該車輛的車輛資訊，該車輛資訊包括該車輛的一車輛速度、一車輛加速度，及一車輛航向角。要特別注意的是，在本實施例中，該車輛感測裝置11例如包括一陀螺儀(Gyroscope)、一里程計(Odometer)、一車速計(Speed Meter)，及一慣性測量單元（Inertial measurement unit, IMU）。
該障礙物感測裝置12用以持續感測與該車輛相距一預定距離範圍
Figure 02_image001
內的至少一個障礙物，以產生對應於該至少一個障礙物的至少一筆障礙物資訊，每筆障礙物資訊包括所對應的障礙物與該車輛的一相對縱向距離、一相對縱向速度，及一相對縱向加速度，與所對應的障礙物的一障礙物位置、一障礙物移動速度、一障礙物加速度，及一障礙物長度。要特別注意的是，在本實施例中，該障礙物感測裝置12例如包括一光學雷達（LiDAR）、一超音波雷達(Supersonic Wave Radar)、一毫米波雷達(Millimeter Wave Radar)及一攝影機。
該導航裝置13儲存有一相關於該車輛所行駛的路線的地圖，該地圖包括每一條道路所對應的車道數，用以持續定位該車輛的一車輛位置，並用以產生一路況資訊，該路況資訊包括一最高限速，及一車道寬。要特別注意的是，在本實施例中，該導航裝置13例如包括一全球定位系統(Global Positioning System, GPS)。
該車流感測裝置15用以感測該車輛所在道路的多個同向車道的車流速度。
該路面摩擦力估測裝置16用以感測該車輛所在道路的一路面摩擦力。
該車用電腦14電連接該車輛感測裝置11、該障礙物感測裝置12、該導航裝置13、該車流感測裝置15，及該路面摩擦力估測裝置16，該車用電腦14儲存一初始軌跡路徑。
參閱圖1與圖2，說明本發明自適應軌跡生成系統1如何執行本發明自適應軌跡生成方法之一實施例，以下詳細說明該實施例所包含的步驟。
在步驟20中，該車用電腦14判定該障礙物感測裝置12之該預定距離範圍
Figure 02_image001
內是否存在一障礙物，當該車用電腦14判定出該障礙物感測裝置12之該預定距離範圍
Figure 02_image001
內存在一障礙物時，流程進行步驟21及步驟25；當該車用電腦14判定出該障礙物感測裝置12之該預定距離範圍
Figure 02_image001
內不存在一障礙物時，則流程進行步驟25。
在步驟21中，該車用電腦14獲得一碰撞時間(Time to crash, TTC)、一碰撞時間變化率(Time to crash rate of change,
Figure 02_image003
)、一碰撞距離(Distance to crash, DTC)、一煞車距離(Distance to brake, DTB)門檻值，及一煞車時間(Time to brake, TTB)。
值得注意的是，該車用電腦14係根據當前時間點的該至少一個障礙物中位於該車輛行駛車道上且在該車輛的前方的一前方障礙物所對應的障礙物資訊的該相對縱向距離、該相對縱向速度，及該相對縱向加速度獲得該碰撞時間。該車用電腦14係根據該碰撞時間及在該前一時間點所獲得的前一碰撞時間，獲得該碰撞時間變化率。該車用電腦14係根據該當前時間點的該車輛位置及該前方障礙物所對應的障礙物資訊的該障礙物位置，獲得該碰撞距離。該車用電腦14係根據該當前時間點的該車輛資訊的該車輛速度及該前方障礙物所對應的障礙物資訊的該障礙物速度獲得該煞車距離門檻值，在本實施例中，該煞車距離門檻值以下式表示
Figure 02_image005
其中，
Figure 02_image007
為該車輛速度( m/ s)，
Figure 02_image009
為該前方障礙物的該障礙物速度( m/ s)， Tr為一預設煞車反應時間( s)，
Figure 02_image011
為該路面摩擦力， g為重力加速度(9.8
Figure 02_image013
)，
Figure 02_image015
為一預設煞車後最小安全距離( m)。該車用電腦14係根據該當前車時間點的該車輛資訊的該車輛速度獲得該車輛將該車輛速度降至零的該煞車時間。
在步驟22中，該車用電腦14根據該碰撞距離、該煞車距離門檻值、該碰撞時間、該煞車時間，及該碰撞時間變化率，判定是否滿足一第一特定條件。當該車用電腦14判定出滿足該第一特定條件時，流程進行步驟23；當該車用電腦14判定出不滿足該第一特定條件時，則流程進行步驟24。要特別注意的是，在本實施例中，該第一特定條件例如為該碰撞距離小於等於該煞車距離門檻值且該碰撞時間小於等於該煞車時間且該碰撞時間變化率小於零。
在步驟23中，該車用電腦14進行自動緊急煞車(Autonomous Emergency Braking, AEB)演算法，以控制該車輛緊急煞車。
在步驟24中，該車用電腦14根據該當前時間點的該路況資訊的該最高限速、該車輛資訊的該車輛速度、該路況資訊的該車輛行駛車道之相鄰車道的車流速度，及該碰撞時間變化率，判定是否滿足一第二特定條件。當該車用電腦14判定出滿足該第二特定條件時，流程進行步驟26；當該車用電腦14判定出不滿足該第二特定條件時，則重複步驟21。要特別注意的是，在本實施例中，該第二特定條件例如為該當前時間點的該路況資訊的該最高限速與該車輛資訊的該車輛速度差大於一第一預定值且該路況資訊的該車輛的行駛的車道的其中之一相鄰車道的車流速度與該最高限速相差小於一第二預定值內且該碰撞時間變化率小於零，該第一預定值例如為每小時20公里(km/hr)，該第二預定值例如為每小時5公里(km/hr)。
在步驟25中，該車用電腦14根據該當前時間點的該車輛資訊的該車輛速度、該當前時間點的該車輛位置及該當前軌跡路徑，判定該當前時間點的該車輛位置與該當前軌跡路徑的終點距離是否小於一臨界值。當該車用電腦14判定出該當前時間點的該車輛位置與該當前軌跡路徑的終點距離小於該臨界值，流程進行步驟26；而當該車用電腦14判定出該當前時間點的該車輛位置與該當前軌跡路徑的終點距離不小於該臨界值時，重複進行步驟25。值得注意的是，該臨界值例如為
Figure 02_image018
公尺，其中
Figure 02_image007
為該車輛速度( m/ s)，2為一預定的時間參數( s)。
要特別注意的是，在本實施例中，當該車用電腦14判定出該障礙物感測裝置12之該預定距離範圍
Figure 02_image001
內存在一障礙物時，步驟21~24與步驟25為分別獨立進行，但不以此為限。
在步驟26中，該車用電腦14根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置、該路況資訊、該碰撞距離、該碰撞時間、該碰撞時間變化率，及該煞車距離門檻值更新該當前軌跡路徑。
搭配參閱圖3，步驟26包括子步驟261~269，以下說明步驟26所包括的子步驟。
在子步驟261中，該車用電腦14根據該當前時間點的該至少一筆障礙物資訊的障礙物位置，判定該至少一個障礙物中是否有在該車輛行駛車道上位於該車輛前方之障礙物。當該車用電腦14判定出該至少一個障礙物中沒有在該車輛行駛車道上位於該車輛前方之障礙物時，流程進行步驟262；而當該車用電腦14判定出該至少一個障礙物中有在該車輛行駛車道上位於該車輛前方之障礙物時，則流程進行步驟263。
在子步驟262中，該車用電腦14獲得一路徑終點。值得注意的是，在本實施例中，該路徑終點例如在該車輛行駛車道上位於該車輛之前方一最大估算距離
Figure 02_image020
的位置，其中
Figure 02_image022
，該最大估算距離
Figure 02_image020
例如為
Figure 02_image024
公尺，中
Figure 02_image007
為該車輛速度( m/ s)，
Figure 02_image026
為一時間參數，其範圍例如為[4,6]秒。
在子步驟263中，該車用電腦14根據該當前時間點的該至少一筆障礙物資訊的障礙物位置，判定該至少一個障礙物中是否有在該車輛行駛車道之相鄰車道上位於該車輛側後方之至少一個後方障礙物。當該車用電腦14判定出該至少一個障礙物中沒有任何後方障礙物時，流程進行步驟264；而當該車用電腦14判定出該至少一個障礙物中有該至少一個後方障礙物時，則流程進行步驟265。
在步驟264中，該車用電腦14根據該當前時間點的該碰撞距離、該車輛資訊的該車輛速度，及該路況資訊的該道路寬，獲得多個在該車輛前方的安全區域。
要特別注意的是，在本實施中，該車用電腦14先根據該當前時間點的該碰撞距離、該車輛資訊的該車輛速度，及該路況資訊的該道路寬獲得一包含該前方障礙物的危險區域，再根據該危險區域獲得一位於該車輛行駛車道且不包含該危險區域的本車道安全區域，以及位於該車輛行駛車道之相鄰車道的一左車道安全區域與一右車道安全區域，舉例來說，參閱圖4，若該車輛的中心位置為(0,0)，該前方障礙物的中心位置為( x f 0, y f 0)，該危險區域為矩形，其長寬分別為2 l與2 w， l為該前方障礙物的障礙物長度，且該車道寬為2 w，則該本車道安全區域
Figure 02_image028
，該左車道安全區域
Figure 02_image030
，該右車道安全區域
Figure 02_image032
。
在步驟265中，該車用電腦14根據該當前時間點的該車輛位置，及該至少一個後方障礙物所對應的障礙物資訊的該障礙物位置，獲得至少一個到達本車位置距離(Distance to host, DTH)。
在步驟266中，該車用電腦14根據該當前時間點的該碰撞距離、該至少一個後方障礙物所對應的障礙物資訊的障礙物移動速度、該至少一到達本車位置距離、該車輛資訊的該車輛速度，及該路況資訊的該車道寬，獲得至少一個在該車輛前方的安全區域。
要特別注意的是，在本實施中，該車用電腦14先根據該當前時間點的該前方障礙物所對應的障礙物資訊的障礙物當前位置、該車輛位置、該車輛資訊的該車輛速度，及該路況資訊的該道路寬獲得一包含該前方障礙物的前方危險區域，再根據該危險區域獲得一位於本車道且不包含該危險區域的本車道安全區域，並對於每一後方障礙物，根據該後方障礙物所對應的障礙物資訊的該障礙物位置判定是否滿足一第三特定條件，該第三特定條件如下式
Figure 02_image034
， 其中，
Figure 02_image036
為該後方障礙物所對應的障礙物資訊的該障礙物速度， L=1.5×DTC-5，且
Figure 02_image038
，
Figure 02_image040
為安全距離/
Figure 02_image036
，該安全距離例如為該後方障礙物的障礙物速度( km/ hr)除以2的距離( m)，若
Figure 02_image036
為每小時80公里時，則安全距離為40公尺，
Figure 02_image042
為該車輛的一未來最低車速，
Figure 02_image044
，其中
Figure 02_image046
， g為重力加速度(9.8
Figure 02_image048
)，
Figure 02_image007
為該車輛速度(
Figure 02_image050
)，當滿足該第三特定條件則該後方障礙物所在車道為危險區域；當不滿足該第三特定條件則獲得一位於該後方障礙物的相鄰車道安全區域。舉例來說，搭配參閱圖5，若該車輛的中心位置為(0,0)，該前方障礙物的中心位置為( x f 0, y f 0)，有一位於左車道的後方障礙物，該後方障礙物的中心位置為( x r 0, y r 0)，且對於該後方障礙物，該車用電腦14判定出滿足該第三特定條件，該前方危險區域為矩形，其長寬分別為2 l與2 w，且該車道寬為2 w，則該本車道安全區域
Figure 02_image052
，該左車道為危險區域，故該左車道安全區域
Figure 02_image053
，該右車道安全區域
Figure 02_image032
。
在步驟267中，該車用電腦14根據該碰撞時間、該碰撞時間變化率、該碰撞距離，及該煞車距離門檻值，從步驟264的該等安全區域或步驟266的該至少一個安全區域中決定一目標安全區域。
要特別注意的是，該車用電腦14根據該碰撞時間、該碰撞時間變化率、該碰撞距離，及該煞車距離門檻值，判定是否滿足一第四特定條件，當滿足該第四特定條件時，該車用電腦14決定在該車輛行駛車道的安全區域為該目標安全區域；當該車用電腦14判定出不滿足該第四特定條件時，該車用電腦14則決定在該車輛行駛車道之其中一相鄰車道的安全區域為該目標安全區域，詳細而言，該第四特定條件例如為該碰撞距離與該煞車距離門檻值之差大於等於零且該碰撞時間減2大於等於零且該碰撞時間變化率大於等於零，當該車用電腦14判定出不滿足該第四特定條件時，該車用電腦14依序根據該碰撞距離與該煞車距離門檻值之差的值、該碰撞時間減2的值，以及該碰撞時間變化率的值從在該車輛行駛車道之相鄰車道的安全區域決定該目標安全區域，數值較大者為優先。
在步驟268中，該車用電腦14獲得一位於該目標安全區域中的路徑終點。
在步驟269中，該車用電腦14根據步驟262或步驟268獲得的該路徑終點、該當前時間點的該車輛資訊的該車輛航向角與該車輛速度、該至少一筆障礙物資訊的該至少一障礙物位置、該至少一障礙物移動速度、與該至少一障礙物加速度、該車輛位置，及該路況資訊的該車道寬產生一待更新軌跡路徑，以更新該當前軌跡路徑。由於本發明之特徵並不在於熟知此技藝者所已知的產生該待更新軌跡路徑的方法，詳細作法載記於Wenda Xu, Junqing Wei, John M. Dolan, Huijing Zhao and Hongbin Zha “ A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles”, IEEE International Conference on Robotics and Automation RiverCentre, pp. 2061-2067, 2012中，為了簡潔，故在此省略了他們的細節。
綜上所述，本發明自適應軌跡生成方法及系統，當該車用電腦14判定出不滿足該第一特定條件且滿足該第二特定條件時，該車用電腦14更新該當前軌跡路徑，以在判定出道路環境改變而有安全疑慮時，及時閃避障礙物，且當該車用電腦14判定出該當前時間點的該車輛位置與該當前軌跡路徑的終點距離小於該臨界值時，該車用電腦14更新該當前軌跡路徑，以在該車輛將要行駛到該當前軌跡路徑前及時更新該當前軌跡路徑，故確實能達成本發明的目的。
惟以上所述者，僅為本發明的實施例而已，當不能以此限定本發明實施的範圍，凡是依本發明申請專利範圍及專利說明書內容所作的簡單的等效變化與修飾，皆仍屬本發明專利涵蓋的範圍內。
1:自適應軌跡生成系統 11:車輛感測裝置 12:障礙物感測裝置 13:導航裝置 14:車用電腦 15:車流感測裝置 16:路面摩擦力估測裝置 20~26:步驟 261~269:子步驟
本發明的其他的特徵及功效，將於參照圖式的實施方式中清楚地呈現，其中： 圖1是一方塊圖，說明本發明自適應軌跡生成系統的一實施例； 圖2是一流程圖，說明本發明自適應軌跡生成方法之一實施例； 圖3是一流程圖，輔助說明圖2步驟26的子步驟； 圖4是一示意圖，說明一車輛前方的安全區域；及 圖5是一示意圖，說明該車輛前方的安全區域。
20~26:步驟

Claims (20)

  1. 一種自適應軌跡生成方法，適用於一車輛，該車輛設置有一系統，該系統包括一車輛感測裝置、一障礙物感測裝置、一導航裝置、一車流感測裝置，及一電連接該車輛感測裝置、該障礙物感測裝置、該導航裝置及該車流感測裝置的車用電腦，該車輛感測裝置用以持續偵測該車輛後產生一相關於該車輛的車輛資訊，該車輛資訊包括該車輛的一車輛速度及一車輛加速度，該障礙物感測裝置用以持續感測與該車輛相距一預定距離範圍內的至少一個障礙物，以產生對應於該至少一個障礙物的至少一筆障礙物資訊，每筆障礙物資訊包括所對應的障礙物的一障礙物位置、一障礙物移動速度，及一障礙物加速度，該導航裝置儲存有一相關於該車輛所行駛的路線的地圖，該地圖包括每一條道路所對應的車道數，該導航裝置用以持續定位該車輛的一車輛位置，並用以產生一路況資訊，該路況資訊包括一最高限速及一車道寬，該車流感測裝置用以感測該車輛所在道路的多個同向車道的車流速度，該車用電腦儲存一當前軌跡路徑，該方法由該車用電腦來實施，並包含以下步驟：(A)根據一當前時間點的該車輛資訊、該車輛位置及該至少一筆障礙物資訊，判定是否滿足一第一特定條件； (B)當判定出不滿足該第一特定條件時，根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置、該路況資訊，及該車流速度，判定是否滿足一第二特定條件；及(C)當判定出滿足該第二特定條件時，根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置，及該路況資訊更新該當前軌跡路徑。
  2. 如請求項1所述的自適應軌跡生成方法，每一障礙物資訊還包括所對應的障礙物與該車輛的一相對縱向距離、一相對縱向速度，及一相對縱向加速度，在步驟(A)前還包含以下子步驟：(D)根據當前時間點的該至少一個障礙物中在該車輛行駛車道上位於該車輛的前方的一前方障礙物所對應的障礙物資訊的該相對縱向距離、該相對縱向速度，及該相對縱向加速度，獲得該前方障礙物與該車輛距離發生碰撞的一碰撞時間，根據該碰撞時間及在前一時間點所獲得的前一碰撞時間，獲得一碰撞時間變化率，根據該當前時間點的該車輛位置及該前方障礙物所對應的障礙物資訊的該障礙物位置，獲得一碰撞距離，根據該當前時間點的該車輛資訊的該車輛速度及該前方障礙物所對應的障礙物資訊的該障礙物速度獲得一煞車距離門檻值，根據該當前車時間點的該車輛資訊的 該車輛速度獲得該車輛將該車輛速度降至零的一煞車時間；在步驟(A)中係根據該碰撞時間、該碰撞時間變化率、該碰撞距離、該煞車距離門檻值，及該煞車時間判定是否滿足該第一特定條件。
  3. 如請求項2所述的自適應軌跡生成方法，其中，在步驟(A)中，該第一特定條件為該碰撞距離小於等於該煞車距離門檻值且該碰撞時間小於等於該煞車時間且該碰撞時間變化率小於零。
  4. 如請求項2所述的自適應軌跡生成方法，該車輛資訊還包括一車輛航向角，其中，在步驟(C)中還根據該碰撞距離、該碰撞時間、該碰撞時間變化率，及該煞車距離門檻值更新該當前軌跡路徑，步驟(C)包括以下子步驟：(C-1)根據該當前時間點的該至少一筆障礙物資訊的障礙物位置，判定該至少一個障礙物中是否有該前方障礙物；(C-2)當判定出該至少一個障礙物中有該前方障礙物時，根據該當前時間點的該至少一筆障礙物資訊的障礙物位置，判定該至少一個障礙物中是否有在該車輛行駛車道之相鄰車道位於該車輛側後方的至少一個後方障礙物；(C-3)當判定出該至少一個障礙物中有該至少一個後方障礙物時，根據該當前時間點的該車輛位 置，及在該車輛行駛車道之相鄰車道位於該車輛側後方的至少一個後方障礙物所對應的障礙物資訊的該障礙物位置，獲得至少一個到達本車位置距離；(C-4)根據該當前時間點的該碰撞距離、該至少一個後方障礙物所對應的障礙物資訊的障礙物移動速度、該至少一到達本車位置距離、該車輛資訊的該車輛速度，及該路況資訊的該車道寬，獲得至少一個在該車輛前方的安全區域；(C-5)根據該碰撞時間、該碰撞時間變化率、該碰撞距離，及該煞車距離門檻值，從該至少一個安全區域中決定一目標安全區域；(C-6)獲得一位於該目標安全區域中的路徑終點；及(C-7)根據該路徑終點、該當前時間點的該車輛資訊的該車輛航向角與該車輛速度、該至少一筆障礙物資訊的該至少一障礙物位置、該至少一障礙物移動速度、與該至少一障礙物加速度、該車輛位置，及該路況資訊的該車道寬產生一待更新軌跡路徑，以更新該當前軌跡路徑。
  5. 如請求項4所述的自適應軌跡生成方法，其中，在步驟(C-4)中，先根據該當前時間點的該前方障礙物所對應的障礙物資訊的障礙物當前位置、該車輛位置、該車輛資訊的該車輛速度，及該路況資訊的 該道路寬獲得一包含該前方障礙物的危險區域，再根據該危險區域獲得一位於該車輛行駛車道且不包含該危險區域車道安全區域，並對於每一後方障礙物，根據該後方障礙物所對應的障礙物資訊的該障礙物位置判定是否滿足一第三特定條件，當不滿足該第三特定條件時，獲得一位於該後方障礙物的相鄰車道安全區域。
  6. 如請求項5所述的自適應軌跡生成方法，其中，在步驟(C-4)中，該第三特定條件為：
    Figure 108135235-A0305-02-0024-10
     其中，DTH為該至少一個到達本車位置距離，v ro 為該後方障礙物所對應的障礙物資訊的該障礙物速度，L=1.5×該碰撞距離-5，且該預定距離範圍
    Figure 108135235-A0305-02-0024-13
    L，t min為一安全距離/v ro ，V min為該車輛的一未來最低車速，
    Figure 108135235-A0305-02-0024-11
    ，a last =|該當前時間點的車輛加速度-0.3．g|，g為重力加速度，v host 為該車輛速度。
  7. 如請求項4所述的自適應軌跡生成方法，其中，在步驟(C-5)中，根據該當前時間點的該碰撞時間、該碰撞時間變化率、該碰撞距離，及該煞車距離門檻值，判定是否滿足一第四特定條件，當滿足該第四特定條件時，該目標安全區域為在該車輛行駛車道的安全區域；當判定出不滿足該第四特定條件 時，該目標安全區域為該車輛行駛車道之其中一相鄰車道的安全區域。
  8. 如請求項7所述的自適應軌跡生成方法，其中，在步驟(C-5)中，該第四特定條件為該碰撞距離與該煞車距離門檻值之差大於等於零且該碰撞時間減2大於等於零且該碰撞時間變化率大於等於零。
  9. 如請求項2所述的自適應軌跡生成方法，其中，在步驟(C)中，該第二特定條件為該當前時間點的該路況資訊的該最高限速與該車輛資訊的該車輛速度差大於一第一預定值且該車輛行駛車道之相鄰車道之其中一者的車流速度與該最高限速相差小於一第二預定值內且該碰撞時間變化率小於零。
  10. 如請求項1所述的自適應軌跡生成方法，在步驟(C)前還包含以下步驟：(F)根據該當前時間點的該車輛資訊的該車輛速度、該當前時間點的該車輛位置，及該當前軌跡路徑，判定該當前時間點的該車輛位置與該當前軌跡路徑的終點距離是否小於一臨界值；及(G)當判定出該當前時間點的該車輛位置與該當前軌跡路徑的終點距離小於該臨界值時，進行步驟(C)。
  11. 一種自適應軌跡生成系統，適用於一車輛，包含：一車輛感測裝置，用以持續偵測該車輛後產生一相關於該車輛的車輛資訊，該車輛資訊包括該 車輛的一車輛速度及一車輛加速度；一障礙物感測裝置，用以持續感測與該車輛相距一預定距離範圍內的至少一個障礙物，以產生對應於該至少一個障礙物的至少一筆障礙物資訊，每筆障礙物資訊包括所對應的障礙物的一障礙物位置、一障礙物移動速度，及一障礙物加速度；一導航裝置，儲存有一相關於該車輛所行駛的路線的地圖，該地圖包括每一條道路所對應的車道數，該導航裝置用以持續定位該車輛的一車輛位置，並用以產生一路況資訊，該路況資訊包括一最高限速及一車道寬；及一車流感測裝置，用以感測該車輛所在道路的多個同向車道的車流速度；及一車用電腦，電連接該車輛感測裝置、該障礙物感測裝置、該導航裝置，及該車流感測裝置，並儲存一當前軌跡路徑；其中，該車用電腦根據一當前時間點的該車輛資訊、該車輛位置及該至少一筆障礙物資訊，判定是否滿足一第一特定條件，當該車用電腦判定出不滿足該第一特定條件時，該車用電腦根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置、該路況資訊，及該車流速度，判定是否滿足一第二特定條件，當該車用電腦判定出滿足該第二特定條件時，該車用電腦根據該當前時間點的 該車輛資訊、該至少一筆障礙物資訊、該車輛位置，及該路況資訊更新該當前軌跡路徑。
  12. 如請求項11所述的自適應軌跡生成系統，其中，每一障礙物資訊還包括所對應的障礙物與該車輛的一相對縱向距離、一相對縱向速度，及一相對縱向加速度，該車用電腦還根據當前時間點的該至少一個障礙物中在該車輛行駛車道上位於該車輛的前方的一前方障礙物所對應的障礙物資訊的該相對縱向距離、該相對縱向速度，及該相對縱向加速度，獲得該前方障礙物與該車輛距離發生碰撞的一碰撞時間，再根據該碰撞時間及在前一時間點所獲得的前一碰撞時間，獲得一碰撞時間變化率，再根據該當前時間點的該車輛位置及該前方障礙物所對應的障礙物資訊的該障礙物位置，獲得一碰撞距離，再根據該當前時間點的該車輛資訊的該車輛速度及該前方障礙物所對應的障礙物資訊的該障礙物速度獲得一煞車距離門檻值，並根據該當前車時間點的該車輛資訊的該車輛速度獲得該車輛將該車輛速度降至零的一煞車時間，且該車用電腦係根據該碰撞時間、該碰撞時間變化率、該碰撞距離、該煞車距離門檻值，及該煞車時間判定是否滿足該第一特定條件。
  13. 如請求項12所述的自適應軌跡生成系統，其中，該第一特定條件為該碰撞距離小於等於該煞車距離 門檻值且該碰撞時間小於等於該煞車時間且該碰撞時間變化率小於零。
  14. 如請求項12所述的自適應軌跡生成系統，其中，該車輛資訊還包括一車輛航向角，該車用電腦還根據該碰撞距離、該碰撞時間、該碰撞時間變化率，及該煞車距離門檻值更新該當前軌跡路徑，並根據該當前時間點的該至少一筆障礙物資訊的障礙物位置，判定該至少一個障礙物中是否有該前方障礙物，當該車用電腦判定出該至少一個障礙物中有該前方障礙物時，該車用電腦根據該當前時間點的該至少一筆障礙物資訊的障礙物位置，判定該至少一個障礙物中是否有在該車輛行駛車道之相鄰車道位於該車輛側後方之至少一個後方障礙物，當該車用電腦判定出該至少一個障礙物中有該至少一個後方障礙物時，該車用電腦根據該當前時間點的該車輛位置，及在該車輛行駛車道之相鄰車道位於該車輛後方之至少一個側後方障礙物所對應之障礙物資訊的該障礙物位置，獲得至少一個到達本車位置距離，且根據該當前時間點的該碰撞距離、該至少一個後方障礙物所對應的障礙物資訊的障礙物移動速度、該至少一到達本車位置距離、該車輛資訊的該車輛速度，及該路況資訊的該車道寬，獲得至少一個在該車輛前方的安全區域，並根據該碰撞時間、該碰撞時間變化率、該碰撞距離，及該煞車 距離門檻值，從該至少一個安全區域中決定一目標安全區域，再獲得一位於該目標安全區域中的路徑終點，最後根據該路徑終點、該當前時間點的該車輛資訊的該車輛航向角與該車輛速度、該至少一筆障礙物資訊的該至少一障礙物位置、該至少一障礙物移動速度、與該至少一障礙物加速度、該車輛位置，及該路況資訊的該車道寬產生一待更新軌跡路徑，以更新該當前軌跡路徑。
  15. 如請求項14所述的自適應軌跡生成系統，其中，該車用電腦先根據該當前時間點的該前方障礙物所對應的障礙物資訊的障礙物當前位置、該車輛位置、該車輛資訊的該車輛速度，及該路況資訊的該道路寬獲得一包含該前方障礙物的危險區域，再根據該危險區域獲得一位於該車輛行駛車道且不包含該危險區域的本車道安全區域，並對於每一後方障礙物，該車用電腦根據該後方障礙物所對應的障礙物資訊的該障礙物位置判定是否滿足一第三特定條件，當不滿足該第三特定條件時，獲得一位於該後方障礙物的相鄰車道安全區域。
  16. 如請求項15所述的自適應軌跡生成系統，其中，該第三特定條件為：
    Figure 108135235-A0305-02-0029-1
     其中，DTH為該至少一個到達本車位置距離，v ro 為 該後方障礙物所對應的障礙物資訊的該障礙物速度，L=1.5×該碰撞距離-5，且該預定距離範圍
    Figure 108135235-A0305-02-0030-12
    L，t min為一安全距離/v ro ，V min為該車輛的一未來最低車速，
    Figure 108135235-A0305-02-0030-2
    ，a last =|該當前時間點的車輛加速度-0.3．g|，g為重力加速度，v host 為該車輛速度。
  17. 如請求項14所述的自適應軌跡生成系統，其中，該車用電腦根據該當前時間點的該碰撞時間、該碰撞時間變化率、該碰撞距離，及該煞車距離門檻值，判定是否滿足一第四特定條件，當滿足該第四特定條件時，該車用電腦決定在該車輛行駛車道的安全區域為該目標安全區域；當判定出不滿足該第四特定條件時，該車用電腦決定在該車輛行駛車道之其中一相鄰車道的安全區域為該目標安全區域。
  18. 如請求項17所述的自適應軌跡生成系統，其中，該第四特定條件為該碰撞距離與該煞車距離門檻值之差大於等於零且該碰撞時間減2大於等於零且該碰撞時間變化率大於等於零。
  19. 如請求項12所述的自適應軌跡生成系統，其中，該第二特定條件為該當前時間點的該路況資訊的該最高限速與該車輛資訊的該車輛速度差大於一第一預定值且該路況資訊的該車輛行駛車道之相鄰車道之其中一者的車流速度與該最高限速相差小於一第二預定值內且該碰撞時間變化率小於零。
  20. 如請求項11所述的自適應軌跡生成系統，其中，該車用電腦根據該當前時間點的該車輛資訊的該車輛速度、該當前時間點的該車輛位置，及該當前軌跡路徑，判定該當前時間點的該車輛位置與該當前軌跡路徑的終點距離是否小於一臨界值，並當該車用電腦判定出該當前時間點的該車輛位置與該當前軌跡路徑的終點距離小於該臨界值時，該車用電腦根據該當前時間點的該車輛資訊、該至少一筆障礙物資訊、該車輛位置，及該路況資訊更新該當前軌跡路徑。
TW108135235A 2019-09-27 2019-09-27 自適應軌跡生成方法及系統 TWI715221B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW108135235A TWI715221B (zh) 2019-09-27 2019-09-27 自適應軌跡生成方法及系統

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW108135235A TWI715221B (zh) 2019-09-27 2019-09-27 自適應軌跡生成方法及系統

Publications (2)

Publication Number Publication Date
TWI715221B true TWI715221B (zh) 2021-01-01
TW202112593A TW202112593A (zh) 2021-04-01

Family

ID=75237288

Family Applications (1)

Application Number Title Priority Date Filing Date
TW108135235A TWI715221B (zh) 2019-09-27 2019-09-27 自適應軌跡生成方法及系統

Country Status (1)

Country Link
TW (1) TWI715221B (zh)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106598055A (zh) * 2017-01-19 2017-04-26 北京智行者科技有限公司 一种智能车局部路径规划方法及其装置、车辆
CN107664993A (zh) * 2016-07-29 2018-02-06 法乐第(北京)网络科技有限公司 一种路径规划方法
WO2018055378A1 (en) * 2016-09-21 2018-03-29 Oxford University Innovation Limited Autonomous route determination
CN110077397A (zh) * 2019-05-14 2019-08-02 芜湖汽车前瞻技术研究院有限公司 一种智能车避障轨迹规划方法及装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107664993A (zh) * 2016-07-29 2018-02-06 法乐第(北京)网络科技有限公司 一种路径规划方法
WO2018055378A1 (en) * 2016-09-21 2018-03-29 Oxford University Innovation Limited Autonomous route determination
CN106598055A (zh) * 2017-01-19 2017-04-26 北京智行者科技有限公司 一种智能车局部路径规划方法及其装置、车辆
CN110077397A (zh) * 2019-05-14 2019-08-02 芜湖汽车前瞻技术研究院有限公司 一种智能车避障轨迹规划方法及装置

Also Published As

Publication number Publication date
TW202112593A (zh) 2021-04-01

Similar Documents

Publication Publication Date Title
TWI674984B (zh) 自動駕駛車輛之行駛軌跡規劃系統及方法
US10310508B2 (en) Vehicle control apparatus
US9714034B2 (en) Vehicle control device
EP3644294B1 (en) Vehicle information storage method, vehicle travel control method, and vehicle information storage device
KR102668309B1 (ko) 자율 주행 차량 및 그를 이용한 차량의 주행 제어 방법
JP4343536B2 (ja) 車用の感知装置
US9229453B1 (en) Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle
US10260889B2 (en) Position estimation device and position estimation method
EP2942687B1 (en) Automated driving safety system
US9340207B2 (en) Lateral maneuver planner for automated driving system
US8170739B2 (en) Path generation algorithm for automated lane centering and lane changing control system
US9708004B2 (en) Method for assisting a driver in driving an ego vehicle and corresponding driver assistance system
JP2019532292A (ja) 車両位置特定の自律走行車両
JP7063043B2 (ja) 車両制御装置、および、決定方法
JP4899626B2 (ja) 走行制御装置
US20220253065A1 (en) Information processing apparatus, information processing method, and information processing program
JP2019530608A (ja) 物体レベル融合の自律走行車両
US20190163189A1 (en) Autonomous Vehicle Sensor Compensation By Monitoring Acceleration
CN118235180A (zh) 预测可行驶车道的方法和装置
CN113504782B (zh) 障碍物防撞方法、装置、系统和移动工具
CA3064011C (en) Driving assistance method and driving assistance apparatus
CN112693454B (zh) 自适应轨迹生成方法及系统
CN111857121A (zh) 基于惯导和激光雷达的巡逻机器人行走避障方法及系统
CN113561992A (zh) 自动驾驶车辆轨迹生成方法、装置、终端设备及介质
TWI715221B (zh) 自適應軌跡生成方法及系統