[go: up one dir, main page]

TWI865064B - Minimum risk decision system and method for changing lane and non-transitory computer readable media - Google Patents

Minimum risk decision system and method for changing lane and non-transitory computer readable media Download PDF

Info

Publication number
TWI865064B
TWI865064B TW112136389A TW112136389A TWI865064B TW I865064 B TWI865064 B TW I865064B TW 112136389 A TW112136389 A TW 112136389A TW 112136389 A TW112136389 A TW 112136389A TW I865064 B TWI865064 B TW I865064B
Authority
TW
Taiwan
Prior art keywords
risk
vehicle
time
lateral
start condition
Prior art date
Application number
TW112136389A
Other languages
Chinese (zh)
Other versions
TW202513370A (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 TW112136389A priority Critical patent/TWI865064B/en
Application granted granted Critical
Publication of TWI865064B publication Critical patent/TWI865064B/en
Publication of TW202513370A publication Critical patent/TW202513370A/en

Links

Images

Landscapes

  • Hardware Redundancy (AREA)
  • Traffic Control Systems (AREA)

Abstract

The present disclosure provides a minimum risk decision system for changing lane which is disposed at a vehicle. The minimum risk decision system includes at least one processor. The processor includes an external risk region calculating module, a system failure judging system, a self-driving starting condition confirming module and a decision module. The external risk region calculating module calculates an external risk region. The system failure judging system judges whether the system fails and whether a lateral module of a backup system is normal. The self-driving starting condition confirming module confirms whether a self-driving starting condition is satisfied. A decision conduct unit conducts a minimum risk decision as any one of an external risk, a system failure risk or a self-driving starting condition unsatisfied risk happens. Therefore, the self-driving satisfies the rule and the driving safety is increased.

Description

車道變換最小風險決策系統及方法與非暫態電腦可讀媒體 Lane change minimum risk decision system and method and non-transient computer-readable medium

本發明有關一種最小風險決策系統及方法與非暫態電腦可讀媒體,且尤其是有關一種車道變換最小風險決策系統及方法與非暫態電腦可讀媒體。The present invention relates to a minimum risk decision system and method and a non-transitory computer-readable medium, and more particularly to a lane change minimum risk decision system and method and a non-transitory computer-readable medium.

近年來,車輛的自動駕駛快速發展,而國際自動機工程師學會(SAE International)與美國國家公路交通安全管理局(NHTSA)依據不同的駕駛輔助及自動化程度的設計,將自駕車的程度分為五個等級。其中,等級三(level 3)自駕車表示自動駕駛系統可具有環境辨識能力,但駕駛可適當進行干涉。In recent years, the autonomous driving of vehicles has developed rapidly, and the Society of Autonomous Vehicle Engineers (SAE International) and the National Highway Traffic Safety Administration (NHTSA) of the United States have divided the degree of autonomous driving into five levels according to the design of different driving assistance and automation levels. Among them, level 3 autonomous driving means that the autonomous driving system can have the ability to recognize the environment, but the driver can intervene appropriately.

為了提升自駕的安全性,聯合國世界車輛法規協調論壇發佈UN R157,以作為等級三(level 3)自駕車的依循標準,其目的是在自駕車發生緊急事件(如系統故障)或自駕不滿足啟動標準時,須具備駕駛權移轉與最小風險的保護機制。現在技術中,較缺乏在車道變換過程中執行最小風險決策,因此,如何使自駕車的車道變換滿足UN R157的規定,遂成相關業者努力的目標。In order to improve the safety of autonomous driving, the United Nations World Forum for Harmonization of Vehicle Regulation issued UN R157 as the standard for level 3 autonomous vehicles. Its purpose is to have a protection mechanism for driving transfer and minimum risk when an emergency occurs (such as system failure) or the autonomous vehicle does not meet the start-up standards. In current technology, there is a lack of minimum risk decision-making during lane change. Therefore, how to make the lane change of autonomous vehicles meet the regulations of UN R157 has become the goal of relevant industry players.

為了解決上述問題,本發明提供一種車道變換最小風險決策系統及方法與非暫態電腦可讀媒體,透過系統架構及方法步驟,可使自駕車在車道變換過程中執行最小風險決策。To solve the above problems, the present invention provides a lane change minimum risk decision system and method and a non-transient computer-readable medium. Through the system architecture and method steps, a self-driving car can perform a minimum risk decision during a lane change process.

依據本發明一實施方式提供一種車道變換最小風險決策系統,其設置於一車輛,車道變換最小風險決策系統包含至少一處理器。前述至少一處理器包含一外在風險區間計算模組、一系統失效判斷模組、一自駕啟動條件確認模組以及一決策模組。外在風險區間計算模組計算車輛進入一換道決策後,於複數時點中任一時點的一當前位置與一前方物體之一碰撞時間,並以碰撞時間計算車輛由當前位置換道至一目標車道的一橫向加速度,以橫向加速度與一最大常規橫向加速度中之一較大者及車輛換道至目標車道的一橫向距離計算一外在風險區間。系統失效判斷模組判斷車輛之一系統於任一時點是否失效,以及車輛之一備援系統的一橫向模組是否有效。自駕啟動條件確認模組基於車輛之一駕駛於任一時點的狀態是否可用,以確認一自駕啟動條件是否滿足。決策模組包含一判斷單元、一橫向分量計算單元、一可行空間計算單元及一決策進行單元。判斷單元判斷車輛是否產生一外在風險、一系統失效風險以及一自駕啟動條件不滿足風險,其中,於系統為正常之狀態下,若一時點的車輛與前方物體間的一相對縱向距離小於等於外在風險區間,則判定產生外在風險;若一時點系統為失效但備援系統的橫向模組為有效,則判定產生系統失效風險;於系統正常且一時點的相對縱向距離大於外在風險區間,但自駕啟動條件不滿足,則判定產生自駕啟動條件不滿足風險。橫向分量計算單元於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,計算車輛換道至前述一時點的目標車道的一車道變換時間,藉以計算車輛的一緊急橫向加速度,並以緊急橫向加速度或一常規橫向加速度計算車輛的一橫向分量。可行空間計算單元於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,以橫向距離、橫向分量及目標車道的一後方物體的一後方物體速度,計算前述一時點於目標車道的一可行空間。決策進行單元於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,進行一最小風險決策,其中於外在風險或系統失效風險發生時,使車輛以橫向分量換道進入可行空間,或減速至靜止;及於自駕啟動條件不滿足風險發生時,使車輛以橫向分量換道進入可行空間,或依換道決策的一原軌跡移動至少一段時間至另一時點,若自駕啟動條件持續不滿足,重新確認前述另一時點的目標車道、換道的橫向分量及可行空間。According to an embodiment of the present invention, a lane change minimum risk decision system is provided, which is arranged in a vehicle, and the lane change minimum risk decision system includes at least one processor. The at least one processor includes an external risk interval calculation module, a system failure judgment module, an automatic driving start condition confirmation module and a decision module. The external risk interval calculation module calculates the collision time between a current position of the vehicle and a front object at any time point among a plurality of time points after the vehicle enters a lane change decision, and uses the collision time to calculate a lateral acceleration of the vehicle when changing lanes from the current position to a target lane, and uses the larger of the lateral acceleration and a maximum normal lateral acceleration and a lateral distance of the vehicle when changing lanes to the target lane to calculate an external risk interval. The system failure judgment module judges whether a system of the vehicle fails at any time point, and whether a lateral module of a backup system of the vehicle is valid. The self-driving start condition confirmation module confirms whether a self-driving start condition is met based on whether a driving status of the vehicle is available at any time point. The decision module includes a judgment unit, a lateral component calculation unit, a feasible space calculation unit and a decision making unit. The judgment unit judges whether the vehicle generates an external risk, a system failure risk, and a risk of not satisfying the self-driving start condition, wherein, when the system is in a normal state, if a relative longitudinal distance between the vehicle and the front object at a certain point in time is less than or equal to the external risk interval, it is determined that the external risk is generated; if the system is failed at a certain point in time but the lateral module of the backup system is valid, it is determined that the system failure risk is generated; when the system is normal and the relative longitudinal distance at a certain point in time is greater than the external risk interval, but the self-driving start condition is not satisfied, it is determined that the risk of not satisfying the self-driving start condition is generated. When any one of the external risk, the system failure risk, and the risk that the self-driving start condition is not satisfied occurs, the lateral component calculation unit calculates a lane change time for the vehicle to change lanes to the target lane at the aforementioned time point, thereby calculating an emergency lateral acceleration of the vehicle, and calculates a lateral component of the vehicle using the emergency lateral acceleration or a normal lateral acceleration. When any one of the external risk, the system failure risk, and the risk that the self-driving start condition is not satisfied occurs, the feasible space calculation unit calculates a feasible space in the target lane at the aforementioned time point using the lateral distance, the lateral component, and a rear object speed of a rear object of the target lane. The decision making unit makes a minimum risk decision when any one of the external risk, the system failure risk and the risk of not satisfying the self-driving start condition occurs, wherein when the external risk or the system failure risk occurs, the vehicle changes lanes with the lateral component to enter a feasible space, or decelerates to a standstill; and when the risk of not satisfying the self-driving start condition occurs, the vehicle changes lanes with the lateral component to enter a feasible space, or moves along an original trajectory of the lane change decision for at least a period of time to another time point, and if the self-driving start condition continues to be not satisfied, the target lane, the lateral component of the lane change and the feasible space at the aforementioned other time point are reconfirmed.

藉此,透過計算外在風險區間及偵測系統是否失效、自駕啟動條件是否滿足,可以判斷是否產生外在風險、系統失效風險以及自駕啟動條件不滿足風險,並計算可行空間以進行最小風險決策,可以使車道變換滿足UN R157的規定,並提升安全性。In this way, by calculating the external risk interval and detecting whether the system fails and whether the conditions for automatic start are met, it is possible to determine whether external risks, system failure risks, and risks of not meeting the conditions for automatic start are generated, and calculate the feasible space to make the minimum risk decision, so that lane changes can meet the provisions of UN R157 and improve safety.

依據前述實施方式之車道變換最小風險決策系統,其中,外在風險區間計算模組可運算 ,T c為碰撞時間,D r為車輛與前方物體間的相對縱向距離,v h為車輛的一本車速度,v t為前方物體的一前方物體速度,a y為以碰撞時間計算的車輛的橫向加速度,a yrgmax為最大常規橫向加速度,a ymax為橫向加速度與最大常規橫向加速度中之較大者,D y為橫向距離,v x為本車速度的一縱向分量,D F為外在風險區間。 According to the lane change minimum risk decision system of the aforementioned implementation method, the external risk interval calculation module can calculate , , and , Tc is the collision time, Dr is the relative longitudinal distance between the vehicle and the front object, vh is the vehicle's ego velocity, vt is the front object velocity of the front object, ay is the vehicle's lateral acceleration calculated based on the collision time, ayrgmax is the maximum normal lateral acceleration, aymax is the larger of the lateral acceleration and the maximum normal lateral acceleration, Dy is the lateral distance, vx is a longitudinal component of the ego velocity, and Df is the external risk interval.

依據前述實施方式之車道變換最小風險決策系統,其中,於判斷單元判定一時點產生外在風險或系統失效風險時,橫向分量計算單元可運算 ,T Lc為車道變換時間,L為車輛的長度,t ISO limit為一法規規範不可跨道時間,a y E為緊急橫向加速度。 According to the lane change minimum risk decision system of the above-mentioned implementation method, when the judgment unit determines that an external risk or a system failure risk occurs at a certain point in time, the lateral component calculation unit can calculate and , T Lc is the lane change time, L is the length of the vehicle, t ISO limit is the time during which the vehicle cannot cross the lane as stipulated by the law, and a y E is the emergency lateral acceleration.

依據前述實施方式之車道變換最小風險決策系統,其中,若一時點的可行空間無障礙物,且緊急橫向加速度小於等於一法規規範緊急橫向加速度上限,則可換道進入可行空間,反之,則減速至停止。According to the lane change minimum risk decision system of the aforementioned implementation method, if there is no obstacle in the feasible space at a certain point in time and the emergency lateral acceleration is less than or equal to the emergency lateral acceleration upper limit specified by the regulations, the lane can be changed to enter the feasible space, otherwise, the vehicle will decelerate to a stop.

依據前述實施方式之車道變換最小風險決策系統,其中,於判斷單元判定一時點產生自駕啟動條件不滿足風險時,橫向分量計算單元能以常規橫向加速度計算橫向分量。According to the lane change minimum risk decision system of the aforementioned implementation method, when the judgment unit determines that the self-driving start condition does not meet the risk at a certain point in time, the lateral component calculation unit can calculate the lateral component using the conventional lateral acceleration.

依據前述實施方式之車道變換最小風險決策系統,其中,若可行空間有障礙物,可等待障礙物離開再以常規橫向加速度進入可行空間。According to the lane change minimum risk decision system of the aforementioned implementation method, if there is an obstacle in the feasible space, the vehicle can wait for the obstacle to leave before entering the feasible space with normal lateral acceleration.

依據前述實施方式之車道變換最小風險決策系統,其中,車輛可向右逐次換道至位於一路肩上的可行空間,並減速至停。According to the lane change minimum risk decision system of the aforementioned implementation method, the vehicle can change lanes to the right one by one to a feasible space on the shoulder of the road and slow down to a stop.

依據前述實施方式之車道變換最小風險決策系統,其中,於判斷單元判定一時點產生自駕啟動條件不滿足風險時,決策進行單元可於前述至少一段時間內提出警示。According to the lane change minimum risk decision system of the aforementioned implementation method, when the judgment unit determines that the self-driving start condition does not meet the risk at a certain point in time, the decision making unit can issue a warning within the aforementioned period of time.

依據本發明另一實施方式提供一種車道變換最小風險決策方法,包含一外在風險區間計算步驟、一系統失效判斷步驟、一自駕啟動條件判斷步驟、一風險判斷步驟、一橫向分量計算步驟、一可行空間計算步驟以及一最小風險決策進行步驟。於外在風險區間計算步驟,使至少一處理器的一外在風險區間計算模組計算一車輛進入一換道決策後,於複數時點中任一時點的一當前位置與一前方物體之一碰撞時間,並以碰撞時間計算車輛由當前位置換道至一目標車道的一橫向加速度,以橫向加速度與一最大常規橫向加速度中之一較大者及車輛換道至目標車道的一橫向距離計算一外在風險區間。於系統失效判斷步驟,使前述至少一處理器的一系統失效判斷模組判斷車輛之一系統於任一時點是否失效,以及車輛之一備援系統的一橫向模組是否有效。於自駕啟動條件判斷步驟,使前述至少一處理器的一自駕啟動條件確認模組基於車輛之一駕駛於任一時點的狀態是否可用,以確認一自駕啟動條件是否滿足。於風險判斷步驟,使前述至少一處理器的一判斷單元判斷車輛是否產生一外在風險、一系統失效風險以及一自駕啟動條件不滿足風險,其中,於系統為正常之狀態下,若一時點的車輛與前方物體間的一相對縱向距離小於等於外在風險區間,則判定產生外在風險;若一時點系統為失效但備援系統的橫向模組為有效,則判定產生系統失效風險;於系統正常且一時點的相對縱向距離大於外在風險區間,但自駕啟動條件不滿足,則判定產生自駕啟動條件不滿足風險。於橫向分量計算步驟,使前述至少一處理器的一橫向分量計算單元於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,計算車輛換道至前述一時點的目標車道的一車道變換時間,藉以計算車輛的一緊急橫向加速度,並以緊急橫向加速度或一常規橫向加速度計算車輛的一橫向分量。於可行空間計算步驟,使前述至少一處理器的一可行空間計算模組於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,以橫向距離、橫向分量及目標車道的一後方物體的一後方物體速度,計算前述一時點的一可行空間。於最小風險決策進行步驟,使前述至少一處理器的一決策進行單元於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,進行一最小風險決策。其中於外在風險或系統失效風險發生時,使車輛以橫向分量換道進入可行空間,或減速至靜止;及於自駕啟動條件不滿足風險發生時,使車輛以橫向分量換道進入可行空間,或依換道決策的一原軌跡移動至少一段時間至另一時點,若自駕啟動條件持續不滿足,重新確認前述另一時點的目標車道、換道的橫向分量及可行空間。According to another embodiment of the present invention, a lane change minimum risk decision method is provided, which includes an external risk interval calculation step, a system failure judgment step, an automatic driving start condition judgment step, a risk judgment step, a lateral component calculation step, a feasible space calculation step and a minimum risk decision execution step. In the external risk interval calculation step, an external risk interval calculation module of at least one processor calculates a collision time between a current position of a vehicle and a front object at any time point in a plurality of time points after the vehicle enters a lane change decision, and calculates a lateral acceleration of the vehicle when changing lanes from the current position to a target lane based on the collision time, and calculates an external risk interval based on the larger of the lateral acceleration and a maximum conventional lateral acceleration and a lateral distance of the vehicle when changing lanes to the target lane. In the system failure judgment step, a system failure judgment module of the at least one processor judges whether a system of the vehicle fails at any time point, and whether a lateral module of a backup system of the vehicle is effective. In the self-driving start condition determination step, an self-driving start condition confirmation module of the at least one processor is enabled to confirm whether an self-driving start condition is satisfied based on whether a driving state of the vehicle at any time point is available. In the risk judgment step, a judgment unit of the at least one processor is made to judge whether the vehicle generates an external risk, a system failure risk, and a risk of not satisfying an automatic start condition, wherein, when the system is in a normal state, if a relative longitudinal distance between the vehicle and the front object at a certain point in time is less than or equal to the external risk interval, it is determined that an external risk is generated; if the system is failed at a certain point in time but the lateral module of the backup system is valid, it is determined that a system failure risk is generated; if the system is normal and the relative longitudinal distance at a certain point in time is greater than the external risk interval, but the automatic start condition is not satisfied, it is determined that a risk of not satisfying the automatic start condition is generated. In the lateral component calculation step, a lateral component calculation unit of the at least one processor calculates a lane change time for the vehicle to change lanes to the target lane at the aforementioned time point when any one of the external risks, the system failure risk, and the risk that the self-driving start condition is not satisfied occurs, so as to calculate an emergency lateral acceleration of the vehicle, and calculate a lateral component of the vehicle using the emergency lateral acceleration or a normal lateral acceleration. In the feasible space calculation step, a feasible space calculation module of the at least one processor is used to calculate a feasible space at the aforementioned time point using the lateral distance, lateral component, and a rear object speed of a rear object of the target lane when any one of the external risks, system failure risks, and the risk of not satisfying the self-driving start condition occurs. In the minimum risk decision making step, a decision making unit of the at least one processor is used to make a minimum risk decision when any one of the external risks, system failure risks, and the risk of not satisfying the self-driving start condition occurs. When external risks or system failure risks occur, the vehicle changes lanes with a lateral component to enter a feasible space, or decelerates to a standstill; and when the risk of unsatisfied autonomous driving start conditions occurs, the vehicle changes lanes with a lateral component to enter a feasible space, or moves along an original trajectory of the lane change decision for at least a period of time to another time point. If the autonomous driving start conditions continue to be unsatisfied, the target lane, the lateral component of the lane change, and the feasible space at the aforementioned other time point are reconfirmed.

依據前述實施方式之車道變換最小風險決策方法,其中,外在風險區間計算模組可運算 ,T c為碰撞時間,D r為車輛與前方物體間的相對縱向距離,v h為車輛的一本車速度,v t為前方物體的一前方物體速度,a y為以碰撞時間計算的車輛的橫向加速度,a yrgmax為最大常規橫向加速度,a ymax為橫向加速度與最大常規橫向加速度中之較大者,D y為橫向距離,v x為本車速度的一縱向分量,D F為外在風險區間。 According to the lane change minimum risk decision method of the aforementioned implementation method, the external risk interval calculation module can calculate , , and , Tc is the collision time, Dr is the relative longitudinal distance between the vehicle and the front object, vh is the vehicle's ego velocity, vt is the front object velocity of the front object, ay is the vehicle's lateral acceleration calculated based on the collision time, ayrgmax is the maximum normal lateral acceleration, aymax is the larger of the lateral acceleration and the maximum normal lateral acceleration, Dy is the lateral distance, vx is a longitudinal component of the ego velocity, and Df is the external risk interval.

依據前述實施方式之車道變換最小風險決策方法,其中,於判斷單元判定一時點產生外在風險或系統失效風險時,橫向分量計算單元可運算 ,T Lc為車道變換時間,L為車輛的長度,t ISO limit為一法規規範不可跨道時間,a y E為緊急橫向加速度。 According to the lane change minimum risk decision method of the above-mentioned implementation method, when the judgment unit determines that an external risk or a system failure risk occurs at a certain point in time, the lateral component calculation unit can calculate and , T Lc is the lane change time, L is the length of the vehicle, t ISO limit is the time during which the vehicle cannot cross the lane as stipulated by the law, and a y E is the emergency lateral acceleration.

依據前述實施方式之車道變換最小風險決策方法,其中,若前述一時點的可行空間無障礙物,且緊急橫向加速度小於等於一法規規範緊急橫向加速度上限,則可換道進入可行空間,反之,則減速至停止。According to the lane change minimum risk decision method of the aforementioned implementation method, if the feasible space at the aforementioned time point is free of obstacles and the emergency lateral acceleration is less than or equal to the emergency lateral acceleration upper limit specified by the regulations, the lane can be changed to enter the feasible space, otherwise, the vehicle will decelerate to a stop.

依據前述實施方式之車道變換最小風險決策方法,其中,於判斷單元判定一時點產生自駕啟動條件不滿足風險時,橫向分量計算單元能以常規橫向加速度計算橫向分量。According to the lane change minimum risk decision method of the aforementioned implementation method, when the judgment unit determines that the self-driving start condition does not meet the risk at a certain point in time, the lateral component calculation unit can calculate the lateral component using the conventional lateral acceleration.

依據前述實施方式之車道變換最小風險決策方法,其中,若可行空間有障礙物,可等待障礙物離開再以常規橫向加速度進入可行空間。According to the lane change minimum risk decision method of the aforementioned implementation method, if there is an obstacle in the feasible space, the vehicle can wait for the obstacle to leave before entering the feasible space with a normal lateral acceleration.

依據前述實施方式之車道變換最小風險決策方法,其中,車輛可向右逐次換道至位於一路肩上的可行空間,並減速至停。According to the lane change minimum risk decision method of the aforementioned implementation method, the vehicle can change lanes to the right one by one to a feasible space on the shoulder of the road and slow down to a stop.

依據前述實施方式之車道變換最小風險決策方法,其中,於判斷單元判定一時點產生自駕啟動條件不滿足風險時,決策進行單元於可前述至少一段時間內提出警示。According to the lane change minimum risk decision method of the aforementioned implementation method, when the judgment unit determines that the self-driving start condition does not meet the risk at a certain point in time, the decision making unit may issue a warning within at least a period of time mentioned above.

依據本發明另一實施方式提供一種非暫態電腦可讀媒體,存儲一電腦程式使至少一處理器執行如下。計算一車輛進入一換道決策後,於複數時點中任一時點的一當前位置與一前方物體之一碰撞時間,並以碰撞時間計算車輛由當前位置換道至一目標車道的一橫向加速度,以橫向加速度與一最大常規橫向加速度中之一較大者及車輛換道至目標車道的一橫向距離計算一外在風險區間。判斷車輛之一系統於任一時點是否失效,以及車輛之一備援系統的一橫向模組是否有效。基於車輛之一駕駛於任一時點的狀態是否可用,以確認一自駕啟動條件是否滿足。判斷車輛是否產生一外在風險、一系統失效風險以及一自駕啟動條件不滿足風險,其中,於系統為正常之狀態下,若一時點的車輛與前方物體間的一相對縱向距離小於等於外在風險區間,則判定產生外在風險;若一時點系統為失效但備援系統的橫向模組為有效,則判定產生系統失效風險;於系統正常且一時點的相對縱向距離大於外在風險區間,但自駕啟動條件不滿足,則判定產生自駕啟動條件不滿足風險。於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,計算車輛換道至前述一時點的目標車道的一車道變換時間,藉以計算車輛的一緊急橫向加速度,並以緊急橫向加速度或一常規橫向加速度計算車輛的一橫向分量。於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,以橫向距離、橫向分量及目標車道的一後方物體的一後方物體速度,計算前述一時點的一可行空間。於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,進行一最小風險決策。其中於外在風險或系統失效風險發生時,使車輛以橫向分量換道進入可行空間,或減速至靜止;及於自駕啟動條件不滿足風險發生時,使車輛以橫向分量換道進入可行空間,或依換道決策的一原軌跡移動至少一段時間至另一時點,若自駕啟動條件持續不滿足,重新確認前述另一時點的目標車道、換道的橫向分量及可行空間。According to another embodiment of the present invention, a non-transitory computer-readable medium is provided, which stores a computer program to enable at least one processor to execute the following. Calculate the collision time between a current position of a vehicle and a front object at any time point among a plurality of time points after the vehicle enters a lane change decision, and calculate a lateral acceleration of the vehicle when changing lanes from the current position to a target lane based on the collision time, and calculate an external risk interval based on the larger of the lateral acceleration and a maximum conventional lateral acceleration and a lateral distance of the vehicle when changing lanes to the target lane. Determine whether a system of the vehicle fails at any time point, and whether a lateral module of a backup system of the vehicle is effective. Whether an autonomous driving start condition is satisfied is determined based on whether a driving status of the vehicle is available at any point in time. Determine whether the vehicle generates an external risk, a system failure risk, and a risk of not satisfying the self-driving start condition, wherein, when the system is in a normal state, if a relative longitudinal distance between the vehicle and the front object at a certain point in time is less than or equal to the external risk interval, it is determined that the external risk is generated; if the system is failed at a certain point in time but the lateral module of the backup system is valid, it is determined that the system failure risk is generated; when the system is normal and the relative longitudinal distance at a certain point in time is greater than the external risk interval, but the self-driving start condition is not satisfied, it is determined that the risk of not satisfying the self-driving start condition is generated. When any one of the external risk, the system failure risk and the risk that the self-driving start condition is not satisfied occurs, a lane change time of the vehicle changing lanes to the target lane at the aforementioned time point is calculated to calculate an emergency lateral acceleration of the vehicle, and a lateral component of the vehicle is calculated using the emergency lateral acceleration or a normal lateral acceleration. When any one of the external risk, the system failure risk and the risk that the self-driving start condition is not satisfied occurs, a feasible space at the aforementioned time point is calculated using the lateral distance, the lateral component and a rear object speed of a rear object of the target lane. When any one of the external risk, the system failure risk and the risk of not satisfying the self-driving start condition occurs, a minimum risk decision is made. When the external risk or the system failure risk occurs, the vehicle changes lanes with the lateral component to enter the feasible space, or decelerates to a standstill; and when the risk of not satisfying the self-driving start condition occurs, the vehicle changes lanes with the lateral component to enter the feasible space, or moves along an original trajectory of the lane change decision for at least a period of time to another time point. If the self-driving start condition continues to be not satisfied, the target lane, the lateral component of the lane change and the feasible space at the aforementioned other time point are reconfirmed.

以下將參照圖式說明本發明之實施例。為明確說明起見,許多實務上的細節將在以下敘述中一併說明。然而,閱讀者應瞭解到,這些實務上的細節不應用以限制本發明。也就是說,在本發明部分實施例中,這些實務上的細節是非必要的。此外,為簡化圖式起見,一些習知慣用的結構與元件在圖式中將以簡單示意的方式繪示;並且重複之元件將可能使用相同的編號或類似的編號表示。The following will describe the embodiments of the present invention with reference to the drawings. For the purpose of clarity, many practical details will be described together in the following description. However, the reader should understand that these practical details should not be used to limit the present invention. That is to say, in some embodiments of the present invention, these practical details are not necessary. In addition, in order to simplify the drawings, some commonly used structures and components will be shown in the drawings in a simple schematic manner; and repeated components may be represented by the same number or similar number.

此外,本文中第一、第二、第三等用語只是用來描述不同元件或成分,而對元件/成分本身並無限制,因此,第一元件/成分亦可改稱為第二元件/成分。且本文中之元件/成分/機構/模組之組合非此領域中之一般周知、常規或習知之組合,不能以元件/成分/機構/模組本身是否為習知,來判定其組合關係是否容易被技術領域中之通常知識者輕易完成。In addition, the terms "first", "second", "third", etc. in this article are only used to describe different elements or components, and do not limit the elements/components themselves. Therefore, the first element/component can also be renamed as the second element/component. Moreover, the combination of elements/components/mechanisms/modules in this article is not a generally known, conventional or familiar combination in this field. Whether the elements/components/mechanisms/modules themselves are known cannot be used to determine whether their combination relationship is easy to be completed by ordinary knowledge in the technical field.

請參閱第1圖及第2圖,其中第1圖繪示依照本發明一實施例之一種車道變換最小風險決策系統1000的系統方塊圖,第2圖繪示第1圖實施例之車道變換最小風險決策系統1000安裝於一車輛CH且應用於一道路上的示意圖。車道變換最小風險決策系統1000設置於車輛CH,車道變換最小風險決策系統1000包含至少一處理器1100。前述至少一處理器1100包含一外在風險區間計算模組1110、一系統失效判斷模組1120、一自駕啟動條件確認模組1130及一決策模組1140。Please refer to FIG. 1 and FIG. 2, wherein FIG. 1 shows a system block diagram of a lane change minimum risk decision system 1000 according to an embodiment of the present invention, and FIG. 2 shows a schematic diagram of the lane change minimum risk decision system 1000 of the embodiment of FIG. 1 being installed on a vehicle CH and applied on a road. The lane change minimum risk decision system 1000 is set on the vehicle CH, and the lane change minimum risk decision system 1000 includes at least one processor 1100. The aforementioned at least one processor 1100 includes an external risk interval calculation module 1110, a system failure judgment module 1120, an automatic driving start condition confirmation module 1130 and a decision module 1140.

外在風險區間計算模組1110計算車輛CH進入一換道決策後,於複數時點中任一時點的一當前位置與一前方物體CT之一碰撞時間,並以碰撞時間計算車輛CH由當前位置換道至一目標車道的一橫向加速度,以橫向加速度與一最大常規橫向加速度中之一較大者及車輛CH換道至目標車道的一橫向距離D y計算一外在風險區間D F。系統失效判斷模組1120判斷車輛CH之一系統於任一時點是否失效,以及車輛CH之一備援系統的一橫向模組是否有效。自駕啟動條件確認模組1130基於車輛CH之一駕駛於任一時點的狀態是否可用,以確認一自駕啟動條件是否滿足。 The external risk interval calculation module 1110 calculates a collision time between a current position of the vehicle CH and a front object CT at any time point in a plurality of time points after the vehicle CH enters a lane change decision, and calculates a lateral acceleration of the vehicle CH from the current position to a target lane using the collision time, and calculates an external risk interval DF using the larger of the lateral acceleration and a maximum normal lateral acceleration and a lateral distance Dy of the vehicle CH from the lane change to the target lane . The system failure judgment module 1120 judges whether a system of the vehicle CH fails at any time point, and whether a lateral module of a backup system of the vehicle CH is effective. The self-driving start condition confirmation module 1130 confirms whether a self-driving start condition is satisfied based on whether a driving state of the vehicle CH is available at any time point.

決策模組1140包含一判斷單元1141、一橫向分量計算單元1142、一可行空間計算單元1143及一決策進行單元1144。判斷單元1141判斷車輛CH是否產生一外在風險、一系統失效風險以及一自駕啟動條件不滿足風險,其中,於系統為正常之狀態下,若前述一時點的車輛CH與前方物體CT間的一相對縱向距離D r小於等於外在風險區間D F(即D r≤D F),則判定產生外在風險;若一時點系統為失效但備援系統的橫向模組為有效,則判定產生系統失效風險;於系統正常且前述一時點的相對縱向距離D r大於外在風險區間D F(即D r>D F),但自駕啟動條件不滿足,則判定產生自駕啟動條件不滿足風險。 The decision module 1140 includes a judgment unit 1141, a lateral component calculation unit 1142, a feasible space calculation unit 1143 and a decision execution unit 1144. The judging unit 1141 judges whether the vehicle CH generates an external risk, a system failure risk, and a risk that the self-driving start condition is not satisfied. In the case where the system is normal, if a relative longitudinal distance D r between the vehicle CH and the front object CT at the aforementioned time point is less than or equal to the external risk interval D F (i.e., D rD F ), it is determined that the external risk is generated; if the system is failed at a time point but the lateral module of the backup system is valid, it is determined that the system failure risk is generated; if the system is normal and the relative longitudinal distance D r at the aforementioned time point is greater than the external risk interval D F (i.e., D r > D F ), but the automatic start conditions are not met, it is determined that the risk of automatic start conditions not being met occurs.

橫向分量計算單元1142於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,計算車輛CH換道至一時點的目標車道的一車道變換時間,藉以計算車輛CH的一緊急橫向加速度,並以緊急橫向加速度或一常規橫向加速度計算車輛CH的一橫向分量v yWhen any one of the external risk, the system failure risk and the risk of the self-driving start condition not being satisfied occurs, the lateral component calculation unit 1142 calculates a lane change time of the vehicle CH to change lanes to a target lane at a certain point in time, thereby calculating an emergency lateral acceleration of the vehicle CH, and calculates a lateral component v y of the vehicle CH using the emergency lateral acceleration or a normal lateral acceleration.

可行空間計算單元1143於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,以橫向距離D y、橫向分量v y及目標車道的一後方物體CR的一後方物體速度v r,計算一時點的一可行空間S1。 When any one of the external risk, the system failure risk and the risk that the autonomous driving start condition is not satisfied occurs, the feasible space calculation unit 1143 calculates a feasible space S1 at a time point using the lateral distance D y , the lateral component v y and a rear object speed v r of a rear object CR in the target lane.

決策進行單元1144於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,進行一最小風險決策,其中於外在風險發生或系統失效風險發生時,使車輛CH以橫向分量v y換道進入可行空間S1,或減速至靜止;及於自駕啟動條件不滿足風險發生時,使車輛CH以橫向分量v y換道進入可行空間S1,或依換道決策的一原軌跡移動至少一段時間至另一時點,若自駕啟動條件持續不滿足,重新確認前述另一時點的目標車道、換道的橫向分量v y及可行空間S1。 The decision making unit 1144 makes a minimum risk decision when any one of the external risk, the system failure risk and the risk of not satisfying the self-driving start condition occurs, wherein when the external risk or the system failure risk occurs, the vehicle CH changes lanes with the lateral component v y to enter the feasible space S1, or decelerates to a standstill; and when the risk of not satisfying the self-driving start condition occurs, the vehicle CH changes lanes with the lateral component v y to enter the feasible space S1, or moves at least for a period of time to another time point according to an original trajectory of the lane change decision. If the self-driving start condition continues to be not satisfied, the target lane at the aforementioned other time point and the lateral component v y of the lane change are re-confirmed. y and feasible space S1.

藉此,透過計算外在風險區間D F及偵測系統是否失效、自駕啟動條件是否滿足,可以判斷是否產生外在風險、系統失效風險以及自駕啟動條件不滿足風險,並計算可行空間S1以進行最小風險決策,可以使車道變換滿足UN R157的規定,並提升安全性。後面將詳述車道變換最小風險決策系統1000的細節。 Thus, by calculating the external risk interval DF and detecting whether the system fails and whether the automatic start condition is satisfied, it is possible to judge whether external risk, system failure risk and risk of not satisfying the automatic start condition are generated, and calculate the feasible space S1 to make a minimum risk decision, so that the lane change meets the provisions of UN R157 and improves safety. The details of the lane change minimum risk decision system 1000 will be described in detail later.

車道變換最小風險決策系統1000的至少一處理器1100是安裝於車輛CH上。具體地,處理器1100的數量可為二,一個處理器1100包含系統(主系統)的控制程式,另一個處理器1100包含備援系統的控制程式。處理器1100可例如為中央處理器(CPU)、數位訊號處理器(DSP)、微處理器(MPU)、微控制器(MCU)等;處理器1100可經程式化而達到特定功能。於本實施例中,各個處理器1100均經程式化後分為外在風險區間計算模組1110、系統失效判斷模組1120、自駕啟動條件確認模組1130及決策模組1140,並且決策模組1140中的不同的程式部分又可分為判斷單元1141、橫向分量計算單元1142、可行空間計算單元1143及決策進行單元1144。而除了上述的功能外,處理器1100亦可經程式化而達到車輛CH的一般控制及影像處理功能,不以此為限。在一實施例中,主系統亦可包含多個車輛上的機構,而能經由主系統的控制程式操控以達成車輛的運行,例如煞車機構及轉向機構等,備援系統的控制程式亦可控制此些機構,或是相同的機構有二組,由主系統控制一組,備援系統控制一組。 At least one processor 1100 of the lane change minimum risk decision system 1000 is installed on the vehicle CH. Specifically, the number of processors 1100 can be two, one processor 1100 includes a control program of the system (main system), and the other processor 1100 includes a control program of the backup system. The processor 1100 can be, for example, a central processing unit (CPU), a digital signal processor (DSP), a microprocessor (MPU), a microcontroller (MCU), etc.; the processor 1100 can be programmed to achieve specific functions. In this embodiment, each processor 1100 is programmed to be divided into an external risk interval calculation module 1110, a system failure judgment module 1120, an automatic driving start condition confirmation module 1130 and a decision module 1140, and different program parts in the decision module 1140 can be divided into a judgment unit 1141, a lateral component calculation unit 1142, a feasible space calculation unit 1143 and a decision making unit 1144. In addition to the above functions, the processor 1100 can also be programmed to achieve general control and image processing functions of the vehicle CH, but is not limited thereto. In one embodiment, the main system may also include multiple mechanisms on the vehicle, which can be controlled by the control program of the main system to achieve the operation of the vehicle, such as the brake mechanism and the steering mechanism, etc. The control program of the backup system can also control these mechanisms, or there are two sets of the same mechanism, one set is controlled by the main system and the other set is controlled by the backup system.

車道變換最小風險決策系統1000可更包含一駕駛狀態偵測裝置1200及一感測模組1300,感測模組1300可包含用以偵測車輛CH外部環境的複數攝影機,而能透過攝影機拍攝當前的環境,如此可以計算出車輛CH與前方物體CT的相對縱向距離Dr、前方物體CT的一前方物體速度vt、車輛CH於車道L1上的當前位置及車道線等資訊,感測模組1300亦可包含雷達以偵測車輛CH附近的障礙物,不以上述為限。駕駛狀態偵測裝置1200可用以偵測駕駛的眼睛、姿態、安全帶等狀態,而供自駕啟動條件確認模組1130判斷自駕啟動條件是否滿足。在本實施例中,自駕啟動條件可例如是ISO21202的PALS狀態機、UNR79或台灣VACC的47-2中的規範。 The lane change minimum risk decision system 1000 may further include a driving state detection device 1200 and a sensing module 1300. The sensing module 1300 may include a plurality of cameras for detecting the external environment of the vehicle CH, and can shoot the current environment through the camera, so as to calculate the relative longitudinal distance D r between the vehicle CH and the front object CT, a front object speed v t of the front object CT, the current position of the vehicle CH on the lane L1 and the lane line, etc. The sensing module 1300 may also include a radar to detect obstacles near the vehicle CH, but is not limited to the above. The driving state detection device 1200 can be used to detect the driver's eyes, posture, seat belt and other states, and the self-driving start condition confirmation module 1130 determines whether the self-driving start condition is met. In this embodiment, the self-driving start condition can be, for example, the PALS state machine of ISO21202, UNR79 or the specification of 47-2 of Taiwan VACC.

外在風險區間計算模組1110可運算Tc=Dr/vt-vh,其中,T c為碰撞時間,D r為車輛CH與前方物體CT間的相對縱向距離,v h為車輛CH的一本車速度,v t為前方物體CT的前方物體速度,a y為以碰撞時間計算的車輛CH的橫向加速度,a yrgmax為最大常規橫向加速度,a ymax為橫向加速度與最大常規橫向加速度中之較大者,D y為橫向距離,v x為本車速度的一縱向分量,D F為外在風險區間。請特別注意,在一般狀態下,車輛欲到達的位置是位於目標車道的中心線,因此橫向距離即為車輛中心與目標車道的中心線之間的距離。 The external risk interval calculation module 1110 can calculate T c =D r /v t -v h , , and , where Tc is the collision time, Dr is the relative longitudinal distance between the vehicle CH and the front object CT, vh is the vehicle velocity of the vehicle CH, vt is the front object velocity of the front object CT, ay is the lateral acceleration of the vehicle CH calculated at the collision time, ayrgmax is the maximum normal lateral acceleration, aymax is the larger of the lateral acceleration and the maximum normal lateral acceleration, Dy is the lateral distance, vx is a longitudinal component of the vehicle velocity, and Df is the external risk interval. Please note that in general, the position that the vehicle wants to reach is the center line of the target lane, so the lateral distance is the distance between the center of the vehicle and the center line of the target lane.

如第1圖及第2圖所示,在車輛CH進行自動駕駛的狀態下,系統可以依據車輛CH所在的當前車道(例如車道L1)及鄰近車道(例如車道L2)的路況決定是否換道。在系統做出換道決策後,車輛CH便開始進行自動換道。而在換道的過程中,外在風險區間計算模組1110會不斷地偵測車輛CH的本車速度v h、車輛CH與前方物體CT間的相對縱向距離D r及前方物體CT的前方物體速度v t,如此運算 以得到碰撞時間(即T c)。之後,可用碰撞時間計算車輛CH的橫向加速度,再與法規規定的最大常規橫向加速度比較,運算 ,即可取得橫向加速度與最大常規橫向加速度中之較大者,並以時間轉空間之概念,運算 以取得外在風險區間D F,而當有何任物體包含前方物體CT在外在風險區間D F內時,若車輛CH持續以系統原先所規畫的方式(例如依原先規畫的速度)繼續進行時,可能會產生碰撞之風險,因此有必要改變路線而提升行車安全。據此,可以運算橫向分量v y及可行空間S1,以規畫新軌跡。 As shown in FIG. 1 and FIG. 2, when the vehicle CH is in the state of automatic driving, the system can decide whether to change lanes according to the road conditions of the current lane (e.g., lane L1) and the adjacent lane (e.g., lane L2) where the vehicle CH is located. After the system makes a lane change decision, the vehicle CH starts to change lanes automatically. During the lane change process, the external risk interval calculation module 1110 continuously detects the vehicle speed v h of the vehicle CH, the relative longitudinal distance D r between the vehicle CH and the front object CT, and the front object speed v t of the front object CT, and calculates To obtain the collision time (i.e. T c ). Afterwards, the collision time can be used to calculate the lateral acceleration of vehicle CH, and then compared with the maximum normal lateral acceleration specified by the law. , we can obtain the larger of the lateral acceleration and the maximum normal lateral acceleration, and use the concept of time-to-space conversion to calculate To obtain the external risk interval D F , and when any object including the front object CT is within the external risk interval D F , if the vehicle CH continues to move in the way originally planned by the system (for example, at the originally planned speed), there may be a risk of collision, so it is necessary to change the route to improve driving safety. Based on this, the lateral component v y and the feasible space S1 can be calculated to plan a new trajectory.

於判斷單元1141判定一時點產生外在風險或系統失效風險時,橫向分量計算單元1142可運算 ,其中,T Lc為車道變換時間,L為車輛CH的長度,t ISO limit為一法規規範不可跨道時間,a y E為緊急橫向加速度。在決定可行空間S1後,車輛CH可準備開始橫向位移至可行空間S1。由於車輛CH在橫向移動時亦會往前進行縱向移動,因此車道變換時間必須考慮車輛CH與前方物體CT間的相對縱向距離D r與車輛CH的長度L之間的差距,以及本車速度v h與前方物體速度v t的關係,也須要考慮在一半的碰撞時間內進入可行空間S1,並且要考量各國法規中所限定之法規規範不可跨道時間,因此可依 取其中之最大者做為車道變換時間,再以此做為緊急橫向加速度計算的基礎。之後,再以緊急橫向加速度計算橫向分量v y。由於此時車輛CH具有高機率發生風險,因此須以較快的速度橫向移動,而能避免發生碰撞。此外,橫向分量計算單元1142可更計算此一橫向分量v y所對應的方向盤角度。 When the judgment unit 1141 determines that an external risk or a system failure risk occurs at a certain point in time, the transverse component calculation unit 1142 can calculate and , where T Lc is the lane change time, L is the length of vehicle CH, t ISO limit is a legal time limit for lane crossing, and a y E is the emergency lateral acceleration. After determining the feasible space S1, vehicle CH can prepare to start lateral displacement to the feasible space S1. Since vehicle CH will also move forward longitudinally when moving laterally, the lane change time must consider the difference between the relative longitudinal distance D r between vehicle CH and the object in front CT and the length L of vehicle CH, as well as the relationship between the vehicle speed v h and the object in front speed v t . It is also necessary to consider entering the feasible space S1 within half of the collision time, and the legal time limit for lane crossing stipulated in the laws of various countries must be considered. Therefore, it can be calculated based on the time limit. The largest of these is taken as the lane change time, and then used as the basis for calculating the emergency lateral acceleration. Afterwards, the lateral component v y is calculated using the emergency lateral acceleration. Since the vehicle CH has a high probability of being at risk at this time, it must move laterally at a faster speed to avoid a collision. In addition, the lateral component calculation unit 1142 can further calculate the steering wheel angle corresponding to this lateral component v y .

又,於判斷單元1141判定一時點產生自駕啟動條件不滿足風險時,橫向分量計算單元1142一樣是運算 ,但可用一般的常規橫向加速度來計算橫向分量vy。在此情況下,由於自駕啟動條件不滿足時,表示只有駕駛是不可用,而系統正常且沒有外在風險,因此車輛CH可用常規橫向加速度進行換道即可。 Furthermore, when the determination unit 1141 determines that the self-driving start condition does not meet the risk at a certain point in time, the lateral component calculation unit 1142 also calculates , but the lateral component v y can be calculated using the normal lateral acceleration. In this case, since the self-driving start condition is not met, it means that only driving is unavailable, while the system is normal and there is no external risk, the vehicle CH can change lanes using the normal lateral acceleration.

可行空間計算單元1143在規畫可行空間S1時,會參考後方物體CR的後方物體速度vr,計算可行空間S1中車輛CH(特別是指車輛CH的車頭)的往前縱向延伸距離DNLF及車輛CH(特別是指車輛CH的車尾)的往後縱向延伸距離DNLR。據此,可依據車輛CH的長度、車輛CH的橫向分量vy及縱向分量vx、後方物體速度vr、及車輛CH與目標車道的橫向距離Dy,以DNLF=(Dy/vy).vx求得往前縱向延伸距離DNLF,及以DNLR=(Dy/vy).max(vx,vr)求得往後縱向延伸距離DNLR。在一實施例中,當可行空間是位於車道或路肩時,可行空間的寬度可以是車道的寬度或是路肩的寬度。而當不包含路肩時,可行空間的一外側邊界(距離車輛較遠的邊界)是一路緣,並且可行空間的一寬度是一車寬,或固定為3.5公尺,而此時目標車道的中心線即是路緣向內半個車寬,或是路緣向內1.75公尺,然不以此為限。在本發明中,目標車道可指鄰近的車道,或是鄰近可供車輛行走之空間,不以有車道線標示的車道為限。 When planning the feasible space S1, the feasible space calculation unit 1143 refers to the rear object speed v r of the rear object CR to calculate the forward longitudinal extension distance D NLF of the vehicle CH (especially the front of the vehicle CH) and the rear longitudinal extension distance D NLR of the vehicle CH (especially the rear of the vehicle CH) in the feasible space S1. Based on this, D NLF = (D y /v y ) can be calculated according to the length of the vehicle CH, the lateral component v y and longitudinal component v x of the vehicle CH, the rear object speed v r , and the lateral distance D y between the vehicle CH and the target lane . v x is used to obtain the forward longitudinal extension distance D NLF , and D NLR =(D y /v y ).max(v x ,v r ) is used to obtain the rearward longitudinal extension distance D NLR . In one embodiment, when the feasible space is located on a lane or a shoulder, the width of the feasible space can be the width of the lane or the width of the shoulder. When the shoulder is not included, an outer boundary of the feasible space (the boundary farther from the vehicle) is an edge, and a width of the feasible space is a car width, or is fixed to 3.5 meters, and at this time, the center line of the target lane is half a car width inward from the edge, or 1.75 meters inward from the edge, but it is not limited thereto. In the present invention, the target lane may refer to a nearby lane, or a nearby space available for vehicles to travel, and is not limited to a lane with lane line markings.

如第2圖所示,在一假設狀況下,車輛CH開始由車道L1換至車道L2,當前方物體CT突然於某一時點減速或煞車,車輛CH的當前位置仍在車道L1上,使得此一時點的相對縱向距離Dr小於等於外在風險區間DF,則判斷單元1141判定產生外在風險,可計算此一時點的緊急橫向加速度藉以計算橫向分量v y,及計算相鄰於車道L1之車道L2上的可行空間S1。若決策進行單元1144判定此一時點車道L2上的可行空間S1無障礙物,且緊急橫向加速度小於等於一法規規範緊急橫向加速度上限,則可通知轉向機構,使車輛CH換道進入車道L2上的可行空間S1,反之,則通知煞車機構,使車輛CH減速至停止。具體地,當緊急橫向加速度小於等於法規規範緊急橫向加速度上限(例如是4公尺/秒平方)時,表示此一緊急橫向加速度是安全而且可以被法規允許的,故可依此緊急橫向加速度計算的橫向分量v y及方向盤角度進入車道L2上的可行空間S1。而當緊急橫向加速度大於法規規範緊急橫向加速度上限時,表示此一緊急橫向加速度並不安全,因此不執行車道變換,直接減速至停止。又,當車道L2上的可行空間S1有障礙物時,表示進入此可行空間S1有被碰撞之可能,故無法執行車道變換,而是直接減速至停止。請特別注意,由於系統的橫向控制有效,因此在減速至停止之前,車輛CH的車身會先回正,再減速停止,此時因有碰撞之可能,故減速度可設定為4公尺/秒平方。 As shown in FIG. 2 , in a hypothetical situation, the vehicle CH starts to change from lane L1 to lane L2. When the front object CT suddenly decelerates or brakes at a certain point in time, the current position of the vehicle CH is still on lane L1, so that the relative longitudinal distance D r at this point in time is less than or equal to the external risk interval D F , then the judgment unit 1141 determines that an external risk occurs, and can calculate the emergency lateral acceleration at this point in time to calculate the lateral component vy , and calculate the feasible space S1 on the lane L2 adjacent to the lane L1. If the decision making unit 1144 determines that the feasible space S1 on the lane L2 at this time point has no obstacles and the emergency lateral acceleration is less than or equal to the upper limit of the emergency lateral acceleration specified by the regulations, the steering mechanism can be notified to make the vehicle CH change lanes and enter the feasible space S1 on the lane L2. Otherwise, the braking mechanism is notified to make the vehicle CH decelerate to a stop. Specifically, when the emergency lateral acceleration is less than or equal to the upper limit of the emergency lateral acceleration specified by the regulations (for example, 4 meters/second squared), it means that this emergency lateral acceleration is safe and permitted by the regulations, so the vehicle can enter the feasible space S1 on the lane L2 according to the lateral component v y calculated by the emergency lateral acceleration and the steering wheel angle. When the emergency lateral acceleration is greater than the upper limit of the emergency lateral acceleration specified by the regulations, it means that this emergency lateral acceleration is not safe, so the lane change is not performed and the vehicle decelerates to a stop directly. In addition, when there is an obstacle in the feasible space S1 on the lane L2, it means that there is a possibility of collision when entering this feasible space S1, so the lane change cannot be performed, but the vehicle decelerates to a stop directly. Please note that since the lateral control of the system is effective, before decelerating to a stop, the body of vehicle CH will first return to the straight position and then decelerate to a stop. At this time, because there is a possibility of collision, the deceleration can be set to 4 meters/second squared.

進一步地,車輛CH可向右逐次換道至位於一路肩L3上的可行空間S1,並減速至停。仔細而言,當車輛CH已由車道L1移至車道L2,即,位於車道L2上的可行空間S1內,可再往右移動至路肩L3,也就是此一時點的目標車道是路肩L3,此時會再計算路肩L3上的可行空間S1及緊急橫向加速度,再使車輛CH換道至路肩L3。如第2圖所示,當車輛CH換道至路肩L3的可行空間S1後,可再減速至停止。由於路肩L3相對安全,故此時的減速度可小於4公尺/秒平方,例如為1公尺/秒平方至3公尺/秒平方。 Furthermore, vehicle CH can change lanes to the right one by one to the feasible space S1 on the shoulder L3, and decelerate to a stop. Specifically, when vehicle CH has moved from lane L1 to lane L2, that is, in the feasible space S1 on lane L2, it can move rightward to shoulder L3, that is, the target lane at this point is shoulder L3. At this time, the feasible space S1 on shoulder L3 and the emergency lateral acceleration will be calculated again, and then vehicle CH will change lanes to shoulder L3. As shown in Figure 2, after vehicle CH changes lanes to the feasible space S1 on shoulder L3, it can decelerate to a stop. Since shoulder L3 is relatively safe, the deceleration at this time can be less than 4 meters/second squared, for example, 1 meter/second squared to 3 meters/second squared.

在另一假設情況下,車輛CH開始由車道L1換至車道L2,系統失效但備援系統的橫向模組有效,此時判斷單元1141判定產生系統失效風險,可計算此一時點的緊急橫向加速度藉以計算橫向分量vy,及計算相鄰於車道L1之車道L2上的可行空間S1。若此一時點的可行空間S1無障礙物,且緊急橫向加速度小於等於法規規範緊急橫向加速度上限,則可換道進入車道L2上的可行空間S1,反之,則減速至停止。請注意系統失效風險產生時的最小風險決策類似於外在風險產生的最小風險決策,然系統失效風險產生時,可能是由包含備援系統控制程式的處理器1100來進行相關的運算。 In another hypothetical situation, vehicle CH starts to change from lane L1 to lane L2, the system fails but the lateral module of the backup system is effective. At this time, the judgment unit 1141 determines that the risk of system failure occurs, and can calculate the emergency lateral acceleration at this point in time to calculate the lateral component v y and the feasible space S1 on lane L2 adjacent to lane L1. If the feasible space S1 at this point in time has no obstacles and the emergency lateral acceleration is less than or equal to the upper limit of the emergency lateral acceleration specified by the regulations, the vehicle can change lanes and enter the feasible space S1 on lane L2. Otherwise, the vehicle decelerates to a stop. Please note that the minimum risk decision when the system failure risk occurs is similar to the minimum risk decision when the external risk occurs. However, when the system failure risk occurs, the processor 1100 including the backup system control program may perform the relevant calculations.

在又一假設情況下,車輛CH開始由車道L1換至車道L2,在某一時點駕駛因故昏迷,駕駛狀態偵測裝置1200偵測駕駛的眼睛後發出駕駛異常之通知給自駕啟動條件確認模組1130,而後續由自駕啟動條件確認模組1130確認自駕啟動條件不滿足。若此時系統正常,也無外在風險產生,判斷單元1141將判定產生自駕啟動條件不滿足風險。在一最小風險決策中,可計算此一時點位於車道L2上的可行空間S1。若此一時點車道L2上的可行空 間S1無障礙物,可以用常規橫向加速度算得之橫向分量vy換道進入可行空間S1;若此一時點車道L2上的可行空間S1有障礙物,則待障礙物離開後,再以常規橫向加速度算得之橫向分量vy換道進入車道L2上的可行空間S1。請注意此時系統正常,故車輛CH可先回正後等待障礙物離開,再進入車道L2上的可行空間S1。並且,待進入車道L2上的可行空間S1後,再計算路肩L3上的可行空間S1,並且以常規橫向加速度算得之橫向分量vy進行換道,也就是車輛CH可向右逐次換道至位於路肩L3上的可行空間S1,最後再減速至停。 In another hypothetical situation, the vehicle CH starts to change from lane L1 to lane L2. At a certain point in time, the driver becomes unconscious for some reason. The driving state detection device 1200 detects the driver's eyes and sends a driving abnormality notification to the self-driving start condition confirmation module 1130. Subsequently, the self-driving start condition confirmation module 1130 confirms that the self-driving start condition is not satisfied. If the system is normal at this time and no external risk occurs, the judgment unit 1141 will determine that the risk of self-driving start condition not being satisfied occurs. In a minimum risk decision, the feasible space S1 on lane L2 at this point in time can be calculated. If there is no obstacle in the feasible space S1 on lane L2 at this time, the lateral component v y calculated by the conventional lateral acceleration can be used to change lanes and enter the feasible space S1; if there is an obstacle in the feasible space S1 on lane L2 at this time, wait until the obstacle is removed, and then change lanes to enter the feasible space S1 on lane L2 using the lateral component v y calculated by the conventional lateral acceleration. Please note that the system is normal at this time, so vehicle CH can first return to the center and wait for the obstacle to leave before entering the feasible space S1 on lane L2. Furthermore, after entering the feasible space S1 on the lane L2, the feasible space S1 on the shoulder L3 is calculated, and the lane change is performed using the lateral component v y calculated using the conventional lateral acceleration. That is, the vehicle CH can change lanes to the right successively to the feasible space S1 on the shoulder L3, and finally decelerate to stop.

在另一最小風險決策中,當判斷單元1141判定產生自駕啟動條件不滿足風險時,是先依換道決策的一原軌跡移動至少一段時間至前述另一時點,再確認自駕啟動條件是否持續不滿足。仔細而言,原軌跡是指由換道決策中,由車道L1換道至車道L2的方向盤角度、速度、加速度等,因系統正常且無外在風險,因此決策進行單元1144可於前述至少一段時間內提出警示,例如警示10秒。在10秒內,原軌跡的移動可能已經完成,也就是車輛CH已由車道L1換道至車道L2。若此時自駕啟動條件是否持續不滿足,表示駕駛可能無反應能力,而應停至路邊以避免產生危險。是以,前述另一時點的車輛CH的當前位置為車道L2,目標車道是路肩L3,而可計算位於路肩L3上的可行空間S1,並減速至停,減速度可小於3公尺/秒平方。請特別注意,雖第2圖實施例是以二車道L1、L2加上一路 肩L3為示例,然應知在其他具有多個車道的實施例中,是逐次向右移動至路肩或路緣內的可行空間。 In another minimum risk decision, when the judgment unit 1141 determines that the risk of the self-driving start condition not being met is generated, it first moves along an original trajectory of the lane change decision for at least a period of time to another aforementioned time point, and then confirms whether the self-driving start condition continues to be unsatisfied. Specifically, the original trajectory refers to the steering wheel angle, speed, acceleration, etc. when changing lanes from lane L1 to lane L2 in the lane change decision. Because the system is normal and there is no external risk, the decision making unit 1144 can issue a warning within the aforementioned at least a period of time, for example, a warning of 10 seconds. Within 10 seconds, the movement of the original trajectory may have been completed, that is, the vehicle CH has changed lanes from lane L1 to lane L2. If the self-driving start condition is not met at this time, it means that the driver may not be able to respond and should stop at the roadside to avoid danger. Therefore, the current position of the vehicle CH at another time point is lane L2, and the target lane is shoulder L3. The feasible space S1 on the shoulder L3 can be calculated, and the vehicle can be decelerated to stop. The deceleration rate can be less than 3 meters/second squared. Please note that although the embodiment of Figure 2 is based on two lanes L1 and L2 plus a shoulder L3 as an example, it should be known that in other embodiments with multiple lanes, the vehicle moves to the right one by one to the feasible space on the shoulder or the edge of the road.

請參閱第3圖,其中第3圖繪示依照本發明另一實施例之一種車道變換最小風險決策方法2000的方塊流程圖。車道變換最小風險決策方法2000包含一外在風險區間計算步驟2100、一系統失效判斷步驟2200、一自駕啟動條件判斷步驟2300、一風險判斷步驟2400、一橫向分量計算步驟2500、一可行空間計算步驟2600及一最小風險決策進行步驟2700。以下將參照第1圖及第2圖的車道變換最小風險決策系統1000說明車道變換最小風險決策方法2000的細節。 Please refer to FIG. 3, wherein FIG. 3 shows a block flow chart of a lane change minimum risk decision method 2000 according to another embodiment of the present invention. The lane change minimum risk decision method 2000 includes an external risk interval calculation step 2100, a system failure judgment step 2200, an automatic driving start condition judgment step 2300, a risk judgment step 2400, a lateral component calculation step 2500, a feasible space calculation step 2600 and a minimum risk decision execution step 2700. The following will explain the details of the lane change minimum risk decision method 2000 with reference to the lane change minimum risk decision system 1000 in Figures 1 and 2.

於外在風險區間計算步驟2100,使至少一處理器1100的一外在風險區間計算模組1110計算車輛CH進入一換道決策後,於複數時點中任一時點的一當前位置與一前方物體CT之一碰撞時間,並以碰撞時間計算車輛CH由當前位置換道至一目標車道的一橫向加速度,以橫向加速度與一最大常規橫向加速度中之一較大者及車輛CH換道至目標車道的一橫向距離Dy計算一外在風險區間DFIn the external risk interval calculation step 2100, an external risk interval calculation module 1110 of at least one processor 1100 calculates a collision time between a current position of the vehicle CH and a front object CT at any time point in a plurality of time points after the vehicle CH enters a lane change decision, and calculates a lateral acceleration of the vehicle CH when changing lanes from the current position to a target lane based on the collision time, and calculates an external risk interval DF based on the larger one of the lateral acceleration and a maximum normal lateral acceleration and a lateral distance Dy when the vehicle CH changes lanes to the target lane.

於系統失效判斷步驟2200,使前述至少一處理器1100的一系統失效判斷模組1120判斷車輛CH之一系統於任一時點是否失效,以及車輛CH之一備援系統的一橫向模組是否有效。 In the system failure judgment step 2200, a system failure judgment module 1120 of the aforementioned at least one processor 1100 is used to judge whether a system of the vehicle CH fails at any time point, and whether a lateral module of a backup system of the vehicle CH is valid.

於自駕啟動條件判斷步驟2300,使前述至少一處理器1100的一自駕啟動條件確認模組1130基於車輛CH之一駕駛於任一時點的狀態是否可用,以確認一自駕啟動條件是否滿足。In the automatic start condition determination step 2300, an automatic start condition confirmation module 1130 of the at least one processor 1100 is enabled to confirm whether an automatic start condition is satisfied based on whether a driving state of the vehicle CH at any time point is available.

於風險判斷步驟2400,使前述至少一處理器1100的一判斷單元1141判斷車輛CH是否產生一外在風險、一系統失效風險以及一自駕啟動條件不滿足風險,其中,於系統為正常之狀態下,若一時點的車輛CH與前方物體CT間的一相對縱向距離D r小於等於外在風險區間D F(即D r≤D F),則判定產生外在風險;若一時點系統為失效但備援系統的橫向模組為有效,則判定產生系統失效風險;於系統正常且一時點的相對縱向距離D r大於外在風險區間D F(即D r>D F),但自駕啟動條件不滿足,則判定產生自駕啟動條件不滿足風險。 In the risk determination step 2400, a determination unit 1141 of the at least one processor 1100 determines whether the vehicle CH generates an external risk, a system failure risk, and a risk that the self-driving start condition is not satisfied. In the case where the system is normal, if a relative longitudinal distance D r between the vehicle CH and the front object CT at a certain point in time is less than or equal to the external risk interval D F (i.e., D rD F ), it is determined that the external risk is generated; if the system is failed at a certain point in time but the lateral module of the backup system is valid, it is determined that the system failure risk is generated; if the system is normal and the relative longitudinal distance D r at a certain point in time is greater than the external risk interval D F (i.e., D r > D F ) , it is determined that the self-driving start condition is not satisfied. ), but the automatic start conditions are not met, it is determined that the risk of automatic start conditions not being met occurs.

於橫向分量計算步驟2500,使前述至少一處理器1100的一橫向分量計算單元1142於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,計算車輛CH換道至前述一時點的目標空間的一車道變換時間,藉以計算車輛CH的一緊急橫向加速度,並以緊急橫向加速度或一常規橫向加速度計算車輛CH的一橫向分量v yIn the lateral component calculation step 2500, a lateral component calculation unit 1142 of the at least one processor 1100 calculates a lane change time for the vehicle CH to change lanes to the target space at the aforementioned time point when any one of the external risk, the system failure risk, and the risk that the self-driving start condition is not satisfied occurs, so as to calculate an emergency lateral acceleration of the vehicle CH, and calculate a lateral component v y of the vehicle CH using the emergency lateral acceleration or a normal lateral acceleration.

於可行空間計算步驟2600,使前述至少一處理器1100的一可行空間計算單元1143於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,以橫向距離D y、橫向分量v y及目標車道的一後方物體CR的一後方物體速度v r,計算前述一時點的一可行空間S1。 In the feasible space calculation step 2600, a feasible space calculation unit 1143 of the at least one processor 1100 calculates a feasible space S1 at the aforementioned time point using the lateral distance D y , the lateral component v y and a rear object speed v r of a rear object CR in the target lane when any one of the external risk, the system failure risk and the risk that the self-driving start condition is not satisfied occurs.

於最小風險決策進行步驟2700,使前述至少一處理器1100的一決策進行單元1144於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,進行一最小風險決策。其中於外在風險或系統失效風險發生時,使車輛CH以橫向分量v y換道進入可行空間S1,或減速至靜止;及於自駕啟動條件不滿足風險發生時,使車輛CH以橫向分量v y換道進入可行空間S1,或依換道決策的一原軌跡移動至少一段時間至另一時點,若自駕啟動條件持續不滿足,重新確認前述另一時點的目標車道、換道的橫向分量v y及可行空間S1。 In the minimum risk decision making step 2700, a decision making unit 1144 of the at least one processor 1100 makes a minimum risk decision when any one of the external risk, the system failure risk and the risk of the self-driving start condition not being satisfied occurs. When an external risk or a system failure risk occurs, the vehicle CH changes lanes with the lateral component v y and enters the feasible space S1, or decelerates to a standstill; and when a risk that the self-driving start condition is not met occurs, the vehicle CH changes lanes with the lateral component v y and enters the feasible space S1, or moves along an original trajectory of the lane change decision for at least a period of time to another time point. If the self-driving start condition continues to be unsatisfied, the target lane, the lateral component v y for lane change, and the feasible space S1 at the aforementioned other time point are reconfirmed.

請參閱第4圖,其中第4圖繪示第3圖實施例之一種車道變換最小風險決策方法2000的一第一細部流程圖。在初始時,於步驟S01,系統(即自駕的主系統)正常運作,且可於步驟S02中,確認駕駛是否介入,即確認駕駛是否介入以自行操控車輛CH。若是,則進入步驟S03,將駕駛權歸還駕駛;若否,則進入步驟S04,確認是否進入換道決策,即,系統是否依目前道路的狀況,決定進行換道。若否,則回至步驟S01,系統繼續運行;若是,則進入步驟S05判斷系統是否失效。Please refer to FIG. 4, wherein FIG. 4 shows a first detailed flow chart of a lane change minimum risk decision method 2000 of the embodiment of FIG. 3. Initially, in step S01, the system (i.e., the main system of the self-driving car) operates normally, and in step S02, it can be confirmed whether the driver intervenes, that is, whether the driver intervenes to control the vehicle CH by itself. If so, it enters step S03 to return the driving right to the driver; if not, it enters step S04 to confirm whether to enter the lane change decision, that is, whether the system decides to change lanes according to the current road conditions. If not, it returns to step S01 and the system continues to operate; if so, it enters step S05 to determine whether the system fails.

若系統失效判斷模組1120於步驟S05中確認系統失效,則進入步驟S06進一步確認備援系統是否失效。若是,則進入步驟S09,車輛CH減速至停;若否,則進入步驟S07,由系統失效判斷模組1120確認備援系統的橫向模組是否失效。若橫向模組失效,則進入步驟S09使車輛CH減速至停,若橫向模組有效,則進入步驟S08,由判斷單元1141判斷車輛CH產生系統失效風險。If the system failure judgment module 1120 confirms that the system has failed in step S05, then the process proceeds to step S06 to further confirm whether the backup system has failed. If so, then the process proceeds to step S09, and the vehicle CH decelerates to a stop; if not, then the process proceeds to step S07, and the system failure judgment module 1120 confirms whether the lateral module of the backup system has failed. If the lateral module has failed, then the process proceeds to step S09 to decelerate the vehicle CH to a stop; if the lateral module is valid, then the process proceeds to step S08, and the judgment unit 1141 judges that the vehicle CH has a system failure risk.

若系統失效判斷模組1120於步驟S05中確認系統正常未失效,則進入步驟S10,由外在風險區間計算模組1110計算外在風險區間D F,而外在風險區間D F的計算方式同上不再贅述。之後,再進入步驟S11由判斷單元1141比較車輛CH與前方物體CT間的相對縱向距離D r是否小於等於外在風險區間D F(即是否滿足D r≤D F)。若是,進入步驟S12由判斷單元1141判斷車輛CH產生外在風險;若否,則進入步驟S13,由自駕啟動條件確認模組1130判斷駕駛是否可用。若駕駛可用,則回至步驟S01,系統繼續運行;若駕駛不可用,則進入步驟S14中,由判斷單元1141判斷車輛CH產生自駕啟動條件不滿足風險。 If the system failure judgment module 1120 confirms in step S05 that the system is normal and has not failed, the process proceeds to step S10, where the external risk interval calculation module 1110 calculates the external risk interval DF , and the calculation method of the external risk interval DF is the same as above and will not be repeated. Thereafter, the process proceeds to step S11, where the judgment unit 1141 compares whether the relative longitudinal distance D r between the vehicle CH and the front object CT is less than or equal to the external risk interval DF (i.e., whether D rDF is satisfied). If yes, the process proceeds to step S12, where the judging unit 1141 judges whether the vehicle CH generates an external risk; if no, the process proceeds to step S13, where the self-driving start condition confirmation module 1130 judges whether driving is available. If driving is available, the process returns to step S01, and the system continues to operate; if driving is not available, the process proceeds to step S14, where the judging unit 1141 judges whether the vehicle CH generates a risk of not satisfying the self-driving start condition.

請參閱第5圖,並配合參閱第1圖及第2圖,其中第5圖繪示第3圖實施例之一種車道變換最小風險決策方法2000的一第二細部流程圖。於步驟S08確認產生系統失效風險、或於步驟S12確認產生外在風險,則可進入步驟S15,由橫向分量計算單元1142計算緊急橫向加速度及橫向分量v y,再進入步驟S16,由可行空間計算單元1143計算可行空間S1,例如,當車輛CH位於車道L1上時,計算車道L2上的可行空間S1。 Please refer to FIG. 5 together with FIG. 1 and FIG. 2, wherein FIG. 5 shows a second detailed flow chart of a lane change minimum risk decision method 2000 of the embodiment of FIG. 3. If it is confirmed in step S08 that a system failure risk is generated, or if it is confirmed in step S12 that an external risk is generated, then step S15 may be entered, and the lateral component calculation unit 1142 calculates the emergency lateral acceleration and the lateral component vy , and then step S16 may be entered, and the feasible space calculation unit 1143 calculates the feasible space S1, for example, when the vehicle CH is located on the lane L1, the feasible space S1 on the lane L2 is calculated.

在產生系統失效風險或外在風險時,若可行空間S1無障礙物,且緊急橫向加速度小於等於一法規規範緊急橫向加速度上限,則可換道進入可行空間S1,反之,則減速至停止。因此,可於步驟S17中確認車道L2上的可行空間S1是否有障礙物,若有,則進入步驟S21,於車道L1減速至停;反之,則進入步驟S18進一步確認所計算之緊急橫向加速度是否符合規範,即,緊急橫向加速度是否小於等於法規規範緊急橫向加速度上限。若是,則進入步驟S19依所計算之方向盤角度及橫向分量v y進入車道L2上的可行空間S1。反之,進入步驟S21於車道L1減速至停。在進入車道L2上的可行空間S1後,可判斷此時的可行空間S1是否是位於路肩(例如路肩L3)或是鄰近路緣。於步驟S20中,若經判斷,確認車道L2並非路肩L3或是鄰近路緣,則回到步驟S15、S16,再次計算橫向分量v y及下一個可行空間S1,例如是路肩L3上的可行空間S1,並且,再依序進行步驟S17、S18、S19、S20,此時確認可行空間S1所在位置是路肩L3,因此進入步驟S21,減速至停。 When a system failure risk or external risk occurs, if there is no obstacle in the feasible space S1 and the emergency lateral acceleration is less than or equal to the upper limit of the emergency lateral acceleration specified by the regulations, the vehicle can change lanes and enter the feasible space S1. Otherwise, the vehicle will decelerate to a stop. Therefore, in step S17, it can be confirmed whether there is an obstacle in the feasible space S1 on the lane L2. If so, the vehicle will proceed to step S21 and decelerate to a stop in the lane L1. Otherwise, the vehicle will proceed to step S18 to further confirm whether the calculated emergency lateral acceleration meets the regulations, that is, whether the emergency lateral acceleration is less than or equal to the upper limit of the emergency lateral acceleration specified by the regulations. If yes, then the process proceeds to step S19 to enter the feasible space S1 on lane L2 according to the calculated steering wheel angle and lateral component v y . Otherwise, the process proceeds to step S21 to decelerate to a stop in lane L1. After entering the feasible space S1 on lane L2, it can be determined whether the feasible space S1 is located on the shoulder (e.g., shoulder L3) or near the curb. In step S20, if it is determined that lane L2 is not the shoulder L3 or the adjacent curb, then return to steps S15 and S16, calculate the lateral component v y and the next feasible space S1 again, for example, the feasible space S1 on the shoulder L3, and then perform steps S17, S18, S19, and S20 in sequence. At this time, it is confirmed that the location of the feasible space S1 is the shoulder L3, so enter step S21 and decelerate to stop.

請參閱第6圖,並配合參閱第1圖及第2圖,其中第6圖繪示第3圖實施例之一種車道變換最小風險決策方法2000的一第三細部流程圖。於步驟S14確認產生自駕啟動條件不滿足風險後,可進入步驟S22,由橫向分量計算單元1142以常規橫向加速度計算橫向分量v y,再進入步驟S23,由可行空間計算單元1143計算可行空間S1,例如是車道L2上的可行空間S1。之後,進入步驟S24確認車道L2上的可行空間S1是否有障礙物,若有,進入步驟S26於車道L1等待,此時可回正並且持續前進等待,並可再回至步驟S22、S23以車輛CH當前位置及相關資料再次更新車道L2上的可行空間S1,及進入步驟S24確認車道L2上的可行空間S1是否有障礙物。若無障礙物,則可進入步驟S25,換道進入車道L2上的可行空間S1。而步驟S27及步驟S28與步驟S20及步驟S21類似,不再贅述。 Please refer to FIG. 6 together with FIG. 1 and FIG. 2, wherein FIG. 6 shows a third detailed flow chart of a lane change minimum risk decision method 2000 of the embodiment of FIG. 3. After confirming in step S14 that the self-driving start condition does not meet the risk, the process proceeds to step S22, where the lateral component calculation unit 1142 calculates the lateral component vy using conventional lateral acceleration, and then proceeds to step S23, where the feasible space calculation unit 1143 calculates the feasible space S1, for example, the feasible space S1 on lane L2. Afterwards, the vehicle enters step S24 to check whether there are obstacles in the feasible space S1 on the lane L2. If there are obstacles, the vehicle enters step S26 to wait in the lane L1. At this time, the vehicle can return to the normal position and continue to wait. The vehicle can return to steps S22 and S23 to update the feasible space S1 on the lane L2 again with the current position and relevant data of the vehicle CH, and enter step S24 to check whether there are obstacles in the feasible space S1 on the lane L2. If there are no obstacles, the vehicle can enter step S25 to change lanes and enter the feasible space S1 on the lane L2. Steps S27 and S28 are similar to steps S20 and S21, and will not be repeated.

請參閱第7圖,並配合參閱第1圖及第2圖,其中第7圖繪示第3圖實施例之一種車道變換最小風險決策方法2000的一第四細部流程圖。在另一方案中,於步驟S14確認產生自駕啟動條件不滿足風險後,可進入步驟S29,先警示並維持原軌跡,即維持由車道L1換道進入車道L2的原軌跡。之後,進入步驟S30,確認駕駛是否可用。若是,表示駕駛可能是睡著,而經警示後已清醒,而可進入步驟S32,使駕駛重啟系統。若否,則進入步驟S31,由橫向分量計算單元1142以常規橫向加速度計算橫向分量v y,再進入步驟S33,計算路肩L3上的可行空間S1。步驟S33、S34、S35、S36、S37、S38與步驟S23至步驟S28類似,不再贅述。 Please refer to FIG. 7, and refer to FIG. 1 and FIG. 2 in conjunction, wherein FIG. 7 shows a fourth detailed flow chart of a lane change minimum risk decision method 2000 of the embodiment of FIG. 3. In another scheme, after confirming in step S14 that the self-driving start condition does not meet the risk, step S29 can be entered to first warn and maintain the original track, that is, maintain the original track of changing lanes from lane L1 to lane L2. After that, step S30 is entered to confirm whether the driver is available. If so, it means that the driver may have fallen asleep, and has awakened after the warning, and step S32 can be entered to restart the driver system. If not, the process proceeds to step S31, where the lateral component calculation unit 1142 calculates the lateral component v y using conventional lateral acceleration, and then proceeds to step S33 to calculate the feasible space S1 on the shoulder L3. Steps S33, S34, S35, S36, S37, and S38 are similar to steps S23 to S28 and will not be described in detail.

在本發明的又一實施例是一種非暫態電腦可讀媒體,存儲一電腦程式使至少一處理器執行如下。計算車輛進入一換道決策後,於複數時點中任一時點的一當前位置與一前方物體之一碰撞時間,並以碰撞時間計算車輛由當前位置換道至一目標車道的一橫向加速度,以橫向加速度與一最大常規橫向加速度中之一較大者及車輛換道至目標車道的一橫向距離計算一外在風險區間。判斷車輛之一系統於任一時點是否失效,以及車輛之一備援系統的一橫向模組是否有效。基於車輛之一駕駛於任一時點的狀態是否可用,以確認一自駕啟動條件是否滿足。判斷車輛是否產生一外在風險、一系統失效風險以及一自駕啟動條件不滿足風險,其中,於系統為正常之狀態下,若一時點的車輛與前方物體間的一相對縱向距離小於等於外在風險區間,則判定產生外在風險;若一時點系統為失效但備援系統的橫向模組為有效,則判定產生系統失效風險;於系統正常且一時點的相對縱向距離大於外在風險區間,但自駕啟動條件不滿足,則判定產生自駕啟動條件不滿足風險。於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,計算車輛換道至前述一時點的目標車道的一車道變換時間,藉以計算車輛的一緊急橫向加速度,並以緊急橫向加速度或一常規橫向加速度計算車輛的一橫向分量。於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,以橫向距離、橫向分量及目標車道的一後方物體的一後方物體速度,計算前述一時點的一可行空間。於外在風險、系統失效風險及自駕啟動條件不滿足風險中任一者產生時,進行一最小風險決策。其中於外在風險或系統失效風險發生時,使車輛以橫向分量換道進入可行空間,或減速至靜止;及於自駕啟動條件不滿足風險發生時,使車輛以橫向分量換道進入可行空間,或依換道決策的一原軌跡移動至少一段時間至另一時點,若自駕啟動條件持續不滿足,重新確認前述另一時點的目標車道、換道的橫向分量及可行空間。Another embodiment of the present invention is a non-transitory computer-readable medium storing a computer program for at least one processor to execute the following. Calculate the collision time between a current position of a vehicle and a front object at any time point in a plurality of time points after the vehicle enters a lane change decision, and calculate a lateral acceleration of the vehicle when changing lanes from the current position to a target lane using the collision time, and calculate an external risk interval using the larger of the lateral acceleration and a maximum conventional lateral acceleration and a lateral distance of the vehicle when changing lanes to the target lane. Determine whether a system of the vehicle fails at any time point, and whether a lateral module of a backup system of the vehicle is effective. Whether an autonomous driving start condition is satisfied is determined based on whether a driving status of the vehicle is available at any point in time. Determine whether the vehicle generates an external risk, a system failure risk, and a risk of not satisfying the self-driving start condition, wherein, when the system is in a normal state, if a relative longitudinal distance between the vehicle and the front object at a certain point in time is less than or equal to the external risk interval, it is determined that the external risk is generated; if the system is failed at a certain point in time but the lateral module of the backup system is valid, it is determined that the system failure risk is generated; when the system is normal and the relative longitudinal distance at a certain point in time is greater than the external risk interval, but the self-driving start condition is not satisfied, it is determined that the risk of not satisfying the self-driving start condition is generated. When any one of the external risk, the system failure risk and the risk that the self-driving start condition is not satisfied occurs, a lane change time of the vehicle changing lanes to the target lane at the aforementioned time point is calculated to calculate an emergency lateral acceleration of the vehicle, and a lateral component of the vehicle is calculated using the emergency lateral acceleration or a normal lateral acceleration. When any one of the external risk, the system failure risk and the risk that the self-driving start condition is not satisfied occurs, a feasible space at the aforementioned time point is calculated using the lateral distance, the lateral component and a rear object speed of a rear object of the target lane. When any one of the external risk, the system failure risk and the risk of not satisfying the self-driving start condition occurs, a minimum risk decision is made. When the external risk or the system failure risk occurs, the vehicle changes lanes with the lateral component to enter the feasible space, or decelerates to a standstill; and when the risk of not satisfying the self-driving start condition occurs, the vehicle changes lanes with the lateral component to enter the feasible space, or moves along an original trajectory of the lane change decision for at least a period of time to another time point. If the self-driving start condition continues to be not satisfied, the target lane, the lateral component of the lane change and the feasible space at the aforementioned other time point are reconfirmed.

非暫態電腦可讀媒體可為可儲存數據且後續可被電腦裝置讀取的任何資料儲存硬體單元,例如記憶體裝置。非暫態電腦可讀媒體可為硬碟、網路附加儲存裝置(Network Attached Storage;NAS)、唯讀記憶體(Read-only memory;ROM)、隨機存取記憶體(Random-access memory;RAM)、唯讀記憶光碟(CD-ROM)、可錄CD(CD-R)、可重複錄寫光碟(CD-RW)、磁帶及其他光學式或非光學式儲存硬體單元。藉此,非暫態電腦可讀媒體所存儲的電腦程式可被讀取及執行。Non-transitory computer-readable media can be any data storage hardware unit that can store data and can be subsequently read by a computer device, such as a memory device. Non-transitory computer-readable media can be hard drives, network attached storage devices (NAS), read-only memory (ROM), random-access memory (RAM), compact discs-read-only memory (CD-ROM), recordable compact discs (CD-R), rewritable compact discs (CD-RW), magnetic tapes, and other optical or non-optical storage hardware units. In this way, computer programs stored on non-transitory computer-readable media can be read and executed.

雖然本發明已以實施例揭露如上,然其並非用以限定本發明,任何熟習此技藝者,在不脫離本發明之精神和範圍內,當可作各種之更動與潤飾,因此本發明之保護範圍當視後附之申請專利範圍所界定者為準。Although the present invention has been disclosed as above by way of embodiments, it is not intended to limit the present invention. Anyone skilled in the art may make various changes and modifications without departing from the spirit and scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the scope defined in the attached patent application.

1000:車道變換最小風險決策系統 1100:處理器 1110:外在風險區間計算模組 1120:系統失效判斷模組 1130:自駕啟動條件確認模組 1140:決策模組 1141:判斷單元 1142:橫向分量計算單元 1143:可行空間計算單元 1144:決策進行單元 1200:駕駛狀態偵測裝置 1300:感測模組 2000:車道變換最小風險決策方法 2100:外在風險區間計算步驟 2200:系統失效判斷步驟 2300:自駕啟動條件判斷步驟 2400:風險判斷步驟 2500:橫向分量計算步驟 2600:可行空間計算步驟 2700:最小風險決策進行步驟 CH:車輛 CT:前方物體 CR:後方物體 D F:外在風險區間 D NLF:往前縱向延伸距離 D NLR:往後縱向延伸距離 D r:相對縱向距離 D y:橫向距離 L1,L2:車道 L3:路肩 S1:可行空間 S01,S02,S03,S04,S05,S06,S07,S08,S09,S10,S11,S12,S13,S14,S15,S16,S17,S18,S19,S20,S21,S22,S23,S24,S25,S26,S27,S28,S29,S30,S31,S32,S33,S34,S35,S36,S37,S38:步驟 v h:本車速度 v r:後方物體速度 v t:前方物體速度 v x:縱向分量 v y:橫向分量 1000: Lane change minimum risk decision system 1100: Processor 1110: External risk interval calculation module 1120: System failure judgment module 1130: Self-driving start condition confirmation module 1140: Decision module 1141: Judgment unit 1142: Lateral component calculation unit 1143: Feasible space calculation unit 1144: Decision making unit 1200: Driving state detection device 13 00: Sensing module 2000: Lane change minimum risk decision method 2100: External risk interval calculation step 2200: System failure judgment step 2300: Self-driving start condition judgment step 2400: Risk judgment step 2500: Transverse component calculation step 2600: Feasible space calculation step 2700: Minimum risk decision step CH: Vehicle CT: Front object CR: Rear object D F : External risk interval D NLF : Forward longitudinal extension distance D NLR : Rear longitudinal extension distance D r : Relative longitudinal distance D y : lateral distance L1, L2: lane L3: shoulder S1: feasible space S01, S02, S03, S04, S05, S06, S07, S08, S09, S10, S11, S12, S13, S14, S15, S16, S17, S18, S19, S20, S21, S22, S23, S24, S25, S26, S27, S28, S29, S30, S31, S32, S33, S34, S35, S36, S37, S38: step v h : vehicle speed v r : rear object speed v t : front object speed v x : longitudinal component v y : lateral component

第1圖繪示依照本發明一實施例之一種車道變換最小風險決策系統的系統方塊圖; 第2圖繪示第1圖實施例之車道變換最小風險決策系統安裝於一車輛且應用於一道路上的示意圖; 第3圖繪示依照本發明另一實施例之一種車道變換最小風險決策方法的方塊流程圖; 第4圖繪示第3圖實施例之一種車道變換最小風險決策方法的一第一細部流程圖; 第5圖繪示第3圖實施例之一種車道變換最小風險決策方法的一第二細部流程圖; 第6圖繪示第3圖實施例之一種車道變換最小風險決策方法的一第三細部流程圖;以及 第7圖繪示第3圖實施例之一種車道變換最小風險決策方法的一第四細部流程圖。 FIG. 1 shows a system block diagram of a lane change minimum risk decision system according to an embodiment of the present invention; FIG. 2 shows a schematic diagram of the lane change minimum risk decision system of the embodiment of FIG. 1 installed on a vehicle and applied on a road; FIG. 3 shows a block flow chart of a lane change minimum risk decision method according to another embodiment of the present invention; FIG. 4 shows a first detailed flow chart of a lane change minimum risk decision method of the embodiment of FIG. 3; FIG. 5 shows a second detailed flow chart of a lane change minimum risk decision method of the embodiment of FIG. 3; FIG. 6 shows a third detailed flow chart of a lane change minimum risk decision method of the embodiment of FIG. 3; and FIG. 7 shows a fourth detailed flow chart of a lane change minimum risk decision method of the embodiment of FIG. 3.

1000:車道變換最小風險決策系統 1000: Lane change minimum risk decision system

1100:處理器 1100: Processor

1110:外在風險區間計算模組 1110: External risk interval calculation module

1120:系統失效判斷模組 1120: System failure judgment module

1130:自駕啟動條件確認模組 1130: Automatic start condition confirmation module

1140:決策模組 1140: Decision-making module

1141:判斷單元 1141: Judgment unit

1142:橫向分量計算單元 1142: Transverse component calculation unit

1143:可行空間計算單元 1143: Feasible space calculation unit

1144:決策進行單元 1144: Decision making unit

1200:駕駛狀態偵測裝置 1200: Driving status detection device

1300:感測模組 1300:Sensor module

Claims (17)

一種車道變換最小風險決策系統,設置於一車輛,該車道變換最小風險決策系統包含:至少一處理器,包含:一外在風險區間計算模組,計算該車輛進入一換道決策後,於複數時點中任一該時點的一當前位置與一前方物體之一碰撞時間,並以該碰撞時間計算該車輛由該當前位置換道至一目標車道的一橫向加速度,以該橫向加速度與一最大常規橫向加速度中之一較大者及該車輛換道至該目標車道的一橫向距離計算一外在風險區間;一系統失效判斷模組,判斷該車輛之一系統於任一該時點是否失效,以及該車輛之一備援系統的一橫向模組是否有效;一自駕啟動條件確認模組,基於該車輛之一駕駛於任一該時點的狀態是否可用,以確認一自駕啟動條件是否滿足;以及一決策模組,包含:一判斷單元,判斷該車輛是否產生一外在風險、一系統失效風險以及一自駕啟動條件不滿足風險,其中,於該系統為正常之狀態下,若一該時點的該車輛與該前方物體間的一相對縱向距離小於等於該外在風險區間,則判定產生該外在風險;若一該時點該系統為失效但該備援系統的該橫向模組為有效,則判定產生該系統失效風險;於該系統正常且一該時點的該相 對縱向距離大於該外在風險區間,但該自駕啟動條件不滿足,則判定產生該自駕啟動條件不滿足風險;一橫向分量計算單元,於該外在風險、該系統失效風險及該自駕啟動條件不滿足風險中任一者產生時,計算該車輛換道至該一時點的該目標車道的一車道變換時間,藉以計算該車輛的一緊急橫向加速度,並以該緊急橫向加速度或一常規橫向加速度計算該車輛的一橫向分量;一可行空間計算單元,於該外在風險、該系統失效風險及該自駕啟動條件不滿足風險中任一者產生時,以該橫向距離、該橫向分量及該目標車道的一後方物體的一後方物體速度,計算該一時點於該目標車道的一可行空間;及一決策進行單元,於該外在風險、該系統失效風險及該自駕啟動條件不滿足風險中任一者產生時,進行一最小風險決策,其中:於該外在風險或於該系統失效風險發生時,使該車輛以該橫向分量換道進入該可行空間,或減速至靜止;及於該自駕啟動條件不滿足風險發生時,使該車輛以該橫向分量換道進入該可行空間,或依該換道決策的一原軌跡移動至少一段時間至另一該時點,若該自駕啟動條件持續不滿足,重新確認該另一時點的該目標車道、換道的該橫向分量及該可行空間。 A lane change minimum risk decision system is provided in a vehicle. The lane change minimum risk decision system comprises: at least one processor, comprising: an external risk interval calculation module, which calculates the collision time between a current position of the vehicle and a front object at any of a plurality of time points after the vehicle enters a lane change decision, and calculates a lateral acceleration of the vehicle when changing lanes from the current position to a target lane based on the collision time, and calculates an external risk interval based on the larger of the lateral acceleration and a maximum conventional lateral acceleration and a lateral distance of the vehicle when changing lanes to the target lane; a system failure judgment module, which judges whether a system of the vehicle fails at any of the time points, and a lateral distance of a backup system of the vehicle. a self-driving start condition confirmation module, based on whether a driving state of the vehicle at any point in time is available, to confirm whether a self-driving start condition is met; and a decision module, including: a judgment unit, judging whether the vehicle generates an external risk, a system failure risk, and a risk of not meeting the self-driving start condition, wherein, in the When the system is in a normal state, if the relative longitudinal distance between the vehicle and the object in front at a certain point in time is less than or equal to the external risk interval, then the external risk is determined to have occurred; if the system is in failure at a certain point in time but the lateral module of the backup system is effective, then the system failure risk is determined to have occurred; when the system is normal and the relative longitudinal distance at a certain point in time is greater than In the external risk interval, but the self-driving start condition is not satisfied, it is determined that the risk of the self-driving start condition not being satisfied is generated; a lateral component calculation unit calculates a lane change time for the vehicle to change lanes to the target lane at the time point when any one of the external risk, the system failure risk and the risk of the self-driving start condition not being satisfied is generated, so as to calculate the vehicle an emergency lateral acceleration of the vehicle, and using the emergency lateral acceleration or a normal lateral acceleration to calculate a lateral component of the vehicle; a feasible space calculation unit, when any one of the external risk, the system failure risk, and the risk that the self-driving start condition is not satisfied occurs, using the lateral distance, the lateral component, and a rear object speed of a rear object of the target lane to calculate a feasible space calculation unit; a degree, calculating a feasible space at the target lane at the time point; and a decision making unit, when any one of the external risk, the system failure risk and the risk that the self-driving start condition is not satisfied occurs, making a minimum risk decision, wherein: when the external risk or the system failure risk occurs, the vehicle changes lanes with the lateral component to enter the feasible space, or decelerate to a standstill; and when the risk of the self-driving start condition not being met occurs, the vehicle changes lanes with the lateral component to enter the feasible space, or moves according to an original trajectory of the lane change decision for at least a period of time to another time point. If the self-driving start condition continues to be unsatisfied, re-confirm the target lane, the lateral component of the lane change and the feasible space at the other time point. 如請求項1所述之車道變換最小風險決策系統,其中,該外在風險區間計算模組運算Tc=Dr/vt-vh、 ay=2Dy/(TC 2)、aymax=max(ay,ayrgmax)及
Figure 112136389-A0305-02-0035-1
,Tc為 該碰撞時間,Dr為該車輛與該前方物體間的該相對縱向距離,vh為該車輛的一本車速度,vt為該前方物體的一前方物體速度,ay為以該碰撞時間計算的該車輛的該橫向加速度,ayrgmax為該最大常規橫向加速度,aymax為該橫向加速度與該最大常規橫向加速度中之該較大者,Dy為該橫向距離,vx為該本車速度的一縱向分量,DF為該外在風險區間。
The lane change minimum risk decision system as claimed in claim 1, wherein the external risk interval calculation module calculates T c =D r /v t -v h , a y =2D y /(T C 2 ), a ymax =max(a y ,a yrgmax ) and
Figure 112136389-A0305-02-0035-1
, T c is the collision time, D r is the relative longitudinal distance between the vehicle and the front object, v h is the vehicle's own vehicle speed, v t is a front object speed of the front object, a y is the lateral acceleration of the vehicle calculated at the collision time, a yrgmax is the maximum normal lateral acceleration, a ymax is the larger of the lateral acceleration and the maximum normal lateral acceleration, D y is the lateral distance, v x is a longitudinal component of the vehicle's own vehicle speed, and D F is the external risk interval.
如請求項2所述之車道變換最小風險決策系統,其中,於該判斷單元判定一該時點產生該外在風險或該系統失效風險時,該橫向分量計算單元運算TLc= max[(Dr-L)/(vt-vh),Tc/2,tISO limit]及
Figure 112136389-A0305-02-0035-2
,TLc為該車道 變換時間,L為該車輛的長度,tISO limit為一法規規範不可跨道時間,ay E為該緊急橫向加速度。
The lane change minimum risk decision system as described in claim 2, wherein when the judgment unit determines that the external risk or the system failure risk occurs at the time point, the lateral component calculation unit calculates T Lc = max[(D r -L)/(v t -v h ),T c /2,t ISO limit ] and
Figure 112136389-A0305-02-0035-2
, T Lc is the lane change time, L is the length of the vehicle, t ISO limit is the time during which lane crossing is prohibited according to regulations, and a y E is the emergency lateral acceleration.
如請求項3所述之車道變換最小風險決策系統,其中,若該一時點的該可行空間無障礙物,且該緊急橫向加速度小於等於一法規規範緊急橫向加速度上限,則換道進入該可行空間,反之,則減速至停止。 The lane change minimum risk decision system as described in claim 3, wherein if the feasible space at that point in time has no obstacles and the emergency lateral acceleration is less than or equal to the emergency lateral acceleration upper limit specified by the regulations, then the lane is changed to enter the feasible space, otherwise, the vehicle is decelerated to a stop. 如請求項2所述之車道變換最小風險決策系 統,其中,於該判斷單元判定一該時點產生該自駕啟動條件不滿足風險時,該橫向分量計算單元以該常規橫向加速度計算該橫向分量。 The lane change minimum risk decision system as described in claim 2, wherein when the judgment unit determines that the self-driving start condition does not meet the risk at the time point, the lateral component calculation unit calculates the lateral component using the conventional lateral acceleration. 如請求項5所述之車道變換最小風險決策系統,其中,若該可行空間有障礙物,等待障礙物離開再以該常規橫向加速度進入該可行空間。 The lane change minimum risk decision system as described in claim 5, wherein if there is an obstacle in the feasible space, wait for the obstacle to leave before entering the feasible space with the normal lateral acceleration. 如請求項4或6所述之車道變換最小風險決策系統,其中,該車輛向右逐次換道至位於一路肩上的該可行空間,並減速至停。 A lane change minimum risk decision system as described in claim 4 or 6, wherein the vehicle changes lanes to the right one by one to the feasible space on the shoulder of the road and decelerates to a stop. 如請求項1所述之車道變換最小風險決策系統,其中,於該判斷單元判定一該時點產生該自駕啟動條件不滿足風險時,該決策進行單元於該至少一段時間內提出警示。 The lane change minimum risk decision system as described in claim 1, wherein when the judgment unit determines that the self-driving start condition does not meet the risk at the time point, the decision making unit issues a warning within the at least one period of time. 一種車道變換最小風險決策方法,包含:一外在風險區間計算步驟,使至少一處理器的一外在風險區間計算模組計算一車輛進入一換道決策後,於複數時點中任一該時點的一當前位置與一前方物體之一碰撞時間,並以該碰撞時間計算該車輛由該當前位置換道至一目標車道的一橫向加速度,以該橫向加速度與一最大常規橫向加速度中之一較大者及該車輛換道至該目標車道的一橫 向距離計算一外在風險區間;一系統失效判斷步驟,使該至少一處理器的一系統失效判斷模組判斷該車輛之一系統於任一該時點是否失效,以及該車輛之一備援系統的一橫向模組是否有效;一自駕啟動條件判斷步驟,使該至少一處理器的一自駕啟動條件確認模組基於該車輛之一駕駛於任一該時點的狀態是否可用,以確認一自駕啟動條件是否滿足;一風險判斷步驟,使該至少一處理器的一判斷單元判斷該車輛是否產生一外在風險、一系統失效風險以及一自駕啟動條件不滿足風險,其中,於該系統為正常之狀態下,若一該時點的該車輛與該前方物體間的一相對縱向距離小於等於該外在風險區間,則判定產生該外在風險;若一該時點該系統為失效但該備援系統的該橫向模組為有效,則判定產生該系統失效風險;於該系統正常且一該時點的該相對縱向距離大於該外在風險區間,但該自駕啟動條件不滿足,則判定產生該自駕啟動條件不滿足風險;一橫向分量計算步驟,使該至少一處理器的一橫向分量計算單元於該外在風險、該系統失效風險及該自駕啟動條件不滿足風險中任一者產生時,計算該車輛換道至該一時點的該目標車道的一車道變換時間,藉以計算該車輛的一緊急橫向加速度,並以該緊急橫向加速度或一常規橫向加速度計算該車輛的一橫向分量;一可行空間計算步驟,使該至少一處理器的一可行空間計算模組於該外在風險、該系統失效風險及該自駕啟動條 件不滿足風險中任一者產生時,以該橫向距離、該橫向分量及該目標車道的一後方物體的一後方物體速度,計算該一時點的一可行空間;以及一最小風險決策進行步驟,使該至少一處理器的一決策進行單元於該外在風險、該系統失效風險及該自駕啟動條件不滿足風險中任一者產生時,進行一最小風險決策,其中:於該外在風險或該系統失效風險發生時,使該車輛以該橫向分量換道進入該可行空間,或減速至靜止;及於該自駕啟動條件不滿足風險發生時,使該車輛以該橫向分量換道進入該可行空間,或依該換道決策的一原軌跡移動至少一段時間至另一該時點,若該自駕啟動條件持續不滿足,重新確認該另一時點的該目標車道、換道的該橫向分量及該可行空間。 A lane change minimum risk decision method includes: an external risk interval calculation step, which enables an external risk interval calculation module of at least one processor to calculate a collision time between a current position of a vehicle and a front object at any of a plurality of time points after a vehicle enters a lane change decision, and calculates a lateral acceleration of the vehicle when changing lanes from the current position to a target lane based on the collision time, An external risk interval is calculated based on the larger of the lateral acceleration and a maximum conventional lateral acceleration and a lateral distance of the vehicle from changing lanes to the target lane; a system failure determination step is performed to enable a system failure determination module of the at least one processor to determine whether a system of the vehicle fails at any point in time and whether a lateral module of a backup system of the vehicle is effective; an automatic driving start A condition determination step, in which an automatic start condition confirmation module of the at least one processor determines whether an automatic start condition is satisfied based on whether a driving state of the vehicle at any point in time is available; a risk determination step, in which a determination unit of the at least one processor determines whether the vehicle generates an external risk, a system failure risk, and a risk of not satisfying the automatic start condition, wherein When the system is in a normal state, if the relative longitudinal distance between the vehicle and the front object at a certain point in time is less than or equal to the external risk interval, it is determined that the external risk occurs; if the system is in failure at a certain point in time but the lateral module of the backup system is effective, it is determined that the system failure risk occurs; when the system is normal and the relative longitudinal distance at a certain point in time is greater than the external risk interval, but If the self-driving start condition is not satisfied, it is determined that the self-driving start condition is not satisfied risk; a lateral component calculation step, so that a lateral component calculation unit of the at least one processor calculates a lane change time of the vehicle changing lanes to the target lane at the time point when any one of the external risk, the system failure risk and the self-driving start condition is not satisfied risk occurs, so as to calculate the vehicle an emergency lateral acceleration, and using the emergency lateral acceleration or a normal lateral acceleration to calculate a lateral component of the vehicle; a feasible space calculation step, causing a feasible space calculation module of the at least one processor to calculate a feasible space calculation module based on the lateral distance, the lateral component and a rear object of the target lane when any one of the external risk, the system failure risk and the risk that the self-driving start condition is not satisfied occurs. a speed of a rear object, calculate a feasible space at that time point; and a minimum risk decision making step, so that a decision making unit of the at least one processor makes a minimum risk decision when any one of the external risk, the system failure risk and the risk that the self-driving start condition is not satisfied occurs, wherein: when the external risk or the system failure risk occurs, the vehicle is made to move with the lateral component Change lanes to enter the feasible space, or decelerate to a standstill; and when the risk of the self-driving start condition not being met occurs, the vehicle changes lanes with the lateral component to enter the feasible space, or moves according to an original trajectory of the lane change decision for at least a period of time to another time point. If the self-driving start condition continues to be unsatisfied, re-confirm the target lane, the lateral component of the lane change and the feasible space at the other time point. 如請求項9所述之車道變換最小風險決策方法,其中,其中,該外在風險區間計算模組運算Tc=Dr/vt-vh、ay=2Dy/(TC 2)、aymax=max(ay,ayrgmax)及
Figure 112136389-A0305-02-0038-3
,Tc為該碰撞時間,Dr為該車輛與該前方 物體間的該相對縱向距離,vh為該車輛的一本車速度,vt為該前方物體的一前方物體速度,ay為以該碰撞時間計算的該車輛的該橫向加速度,ayrgmax為該最大常規橫向加速度,aymax為該橫向加速度與該最大常規橫向加速度中之該較大者,Dy為該橫向距離,vx為該本車速度的一縱向分 量,DF為該外在風險區間。
The lane change minimum risk decision method as claimed in claim 9, wherein the external risk interval calculation module calculates T c =D r /v t -v h , a y =2D y /(T C 2 ), a ymax =max(a y ,a yrgmax ) and
Figure 112136389-A0305-02-0038-3
, T c is the collision time, D r is the relative longitudinal distance between the vehicle and the front object, v h is the vehicle's own vehicle speed, v t is a front object speed of the front object, a y is the lateral acceleration of the vehicle calculated at the collision time, a yrgmax is the maximum normal lateral acceleration, a ymax is the larger of the lateral acceleration and the maximum normal lateral acceleration, D y is the lateral distance, v x is a longitudinal component of the vehicle's own vehicle speed, and D F is the external risk interval.
如請求項10所述之車道變換最小風險決策方法,其中,於該判斷單元判定一該時點產生該外在風險或該系統失效風險時,該橫向分量計算單元運算TLc=max[(Dr-L)/(vt-vh),Tc/2,tISO limit]及ay E=Dy/(TLc 2),TLc為該車道變換時間,L為該車輛的長度,tISO limit為一法規規範不可跨道時間,ay E為該緊急橫向加速度。 The lane change minimum risk decision method as described in claim 10, wherein, when the judgment unit determines that the external risk or the system failure risk occurs at a time point, the lateral component calculation unit calculates T Lc =max[(D r -L)/(v t -v h ),T c /2,t ISO limit ] and a y E =D y /(T Lc 2 ), T Lc is the lane change time, L is the length of the vehicle, t ISO limit is a regulatory time limit for not crossing lanes, and a y E is the emergency lateral acceleration. 如請求項11所述之車道變換最小風險決策方法,其中,若該一時點的該可行空間無障礙物,且該緊急橫向加速度小於等於一法規規範緊急橫向加速度上限,則換道進入該可行空間,反之,則減速至停止。 The lane change minimum risk decision method as described in claim 11, wherein if the feasible space at that point in time has no obstacles and the emergency lateral acceleration is less than or equal to the emergency lateral acceleration upper limit specified by the regulations, then the lane is changed to enter the feasible space, otherwise, the vehicle is decelerated to a stop. 如請求項10所述之車道變換最小風險決策方法,其中,於該判斷單元判定一該時點產生該自駕啟動條件不滿足風險時,該橫向分量計算單元以該常規橫向加速度計算該橫向分量。 The lane change minimum risk decision method as described in claim 10, wherein when the judgment unit determines that the self-driving start condition does not meet the risk at the time point, the lateral component calculation unit calculates the lateral component using the conventional lateral acceleration. 如請求項13所述之車道變換最小風險決策方法,其中,若該可行空間有障礙物,等待障礙物離開再以該常規橫向加速度進入該可行空間。 The lane change minimum risk decision method as described in claim 13, wherein if there is an obstacle in the feasible space, wait for the obstacle to leave before entering the feasible space with the normal lateral acceleration. 如請求項12或14所述之車道變換最小風 險決策方法,其中,該車輛向右逐次換道至位於一路肩上的該可行空間,並減速至停。 The lane change minimum risk decision method as described in claim 12 or 14, wherein the vehicle changes lanes to the right one by one to the feasible space on the shoulder of the road and decelerates to a stop. 如請求項9所述之車道變換最小風險決策方法,其中,於該判斷單元判定一該時點產生該自駕啟動條件不滿足風險時,該決策進行單元於該至少一段時間內提出警示。 The lane change minimum risk decision method as described in claim 9, wherein when the judgment unit determines that the self-driving start condition does not meet the risk at the time point, the decision making unit issues a warning within the at least one period of time. 一種非暫態電腦可讀媒體,存儲一電腦程式使至少一處理器執行如下:計算一車輛進入一換道決策後,於複數時點中任一該時點的一當前位置與一前方物體之一碰撞時間,並以該碰撞時間計算該車輛由該當前位置換道至一目標車道的一橫向加速度,以該橫向加速度與一最大常規橫向加速度中之一較大者及該車輛換道至該目標車道的一橫向距離計算一外在風險區間;判斷該車輛之一系統於任一該時點是否失效,以及該車輛之一備援系統的一橫向模組是否有效;基於該車輛之一駕駛於任一該時點的狀態是否可用,以確認一自駕啟動條件是否滿足;判斷該車輛是否產生一外在風險、一系統失效風險以及一自駕啟動條件不滿足風險,其中,於該系統為正常之狀態下,若一該時點的該車輛與該前方物體間的一相對縱向距離小於等於該外在風險區間,則判定產生該外在風險; 若一該時點該系統為失效但該備援系統的該橫向模組為有效,則判定產生該系統失效風險;於該系統正常且一該時點的該相對縱向距離大於該外在風險區間,但該自駕啟動條件不滿足,則判定產生該自駕啟動條件不滿足風險;於該外在風險、該系統失效風險及該自駕啟動條件不滿足風險中任一者產生時,計算該車輛換道至該一時點的該目標車道的一車道變換時間,藉以計算該車輛的一緊急橫向加速度,並以該緊急橫向加速度或一常規橫向加速度計算該車輛的一橫向分量;於該外在風險、該系統失效風險及該自駕啟動條件不滿足風險中任一者產生時,以該橫向距離、該橫向分量及該目標車道的一後方物體的一後方物體速度,計算該一時點的一可行空間;以及於該外在風險、該系統失效風險及該自駕啟動條件不滿足風險中任一者產生時,進行一最小風險決策,其中:於該外在風險或該系統失效風險發生時,使該車輛以該橫向分量換道進入該可行空間,或減速至靜止;及於該自駕啟動條件不滿足風險發生時,使該車輛以該橫向分量換道進入該可行空間,或依該換道決策的一原軌跡移動至少一段時間至另一該時點,若該自駕啟動條件持續不滿足,重新確認該另一時點的該目標車道、換道的該橫向分量及該可行空間。 A non-transitory computer-readable medium stores a computer program that enables at least one processor to execute the following: calculate a collision time between a current position of a vehicle and a front object at any of a plurality of time points after a vehicle enters a lane-changing decision, and use the collision time to calculate a lateral acceleration of the vehicle when changing lanes from the current position to a target lane, and use the larger of the lateral acceleration and a maximum conventional lateral acceleration and a lateral distance of the vehicle when changing lanes to the target lane to calculate an external risk interval; determine whether a system of the vehicle fails at any of the time points, and whether a lateral module of a backup system of the vehicle is effective; based on the vehicle's Whether the state of a driver at any point in time is available to confirm whether an automatic start condition is met; determine whether the vehicle generates an external risk, a system failure risk, and a risk of not meeting the automatic start condition, wherein, when the system is in a normal state, if a relative longitudinal distance between the vehicle and the front object at that point in time is less than or equal to the external risk interval, then it is determined that the external risk is generated; if the system is failed at that point in time but the lateral module of the backup system is valid, then it is determined that the system failure risk is generated; when the system is normal and the relative longitudinal distance at that point in time is greater than the external risk interval, but the automatic start condition is If the condition is not satisfied, it is determined that the risk of the self-driving start condition not being satisfied occurs; when any one of the external risk, the system failure risk and the risk of the self-driving start condition not being satisfied occurs, a lane change time of the vehicle changing lanes to the target lane at that time point is calculated, so as to calculate an emergency lateral acceleration of the vehicle, and the The method comprises: calculating a lateral component of the vehicle using an emergency lateral acceleration or a normal lateral acceleration; and calculating a possible lateral component of the vehicle using the lateral distance, the lateral component and a rear object speed of a rear object of the target lane when any one of the external risk, the system failure risk and the risk that the self-driving start condition is not satisfied occurs. and when any one of the external risk, the system failure risk, and the risk that the self-driving start condition is not satisfied occurs, a minimum risk decision is made, wherein: when the external risk or the system failure risk occurs, the vehicle changes lanes with the lateral component to enter the feasible space, or decelerates to a standstill; and when the self-driving start condition is When the risk of the lane change condition not being met occurs, the vehicle changes lanes with the lateral component to enter the feasible space, or moves according to an original track of the lane change decision for at least a period of time to another time point. If the self-driving start condition continues to be unsatisfied, the target lane, the lateral component of the lane change and the feasible space at the other time point are reconfirmed.
TW112136389A 2023-09-22 2023-09-22 Minimum risk decision system and method for changing lane and non-transitory computer readable media TWI865064B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW112136389A TWI865064B (en) 2023-09-22 2023-09-22 Minimum risk decision system and method for changing lane and non-transitory computer readable media

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW112136389A TWI865064B (en) 2023-09-22 2023-09-22 Minimum risk decision system and method for changing lane and non-transitory computer readable media

Publications (2)

Publication Number Publication Date
TWI865064B true TWI865064B (en) 2024-12-01
TW202513370A TW202513370A (en) 2025-04-01

Family

ID=94769157

Family Applications (1)

Application Number Title Priority Date Filing Date
TW112136389A TWI865064B (en) 2023-09-22 2023-09-22 Minimum risk decision system and method for changing lane and non-transitory computer readable media

Country Status (1)

Country Link
TW (1) TWI865064B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN119370090A (en) * 2024-12-27 2025-01-28 北京京东远升科技有限公司 Driving control method, driving control device and intelligent driving vehicle

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115123227A (en) * 2021-03-24 2022-09-30 华为技术有限公司 Lane changing decision method and device and vehicle
CN116080648A (en) * 2022-12-15 2023-05-09 宁波均胜智能汽车技术研究院有限公司 Transverse lane changing method considering multi-vehicle interaction, intelligent vehicle and storage medium
CN116494976A (en) * 2023-04-17 2023-07-28 重庆长安汽车股份有限公司 Method, device and storage medium for controlling vehicle lane change
CN116749976A (en) * 2023-07-03 2023-09-15 苏州利氪科技有限公司 Lane changing control method and apparatus

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115123227A (en) * 2021-03-24 2022-09-30 华为技术有限公司 Lane changing decision method and device and vehicle
CN116080648A (en) * 2022-12-15 2023-05-09 宁波均胜智能汽车技术研究院有限公司 Transverse lane changing method considering multi-vehicle interaction, intelligent vehicle and storage medium
CN116494976A (en) * 2023-04-17 2023-07-28 重庆长安汽车股份有限公司 Method, device and storage medium for controlling vehicle lane change
CN116749976A (en) * 2023-07-03 2023-09-15 苏州利氪科技有限公司 Lane changing control method and apparatus

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN119370090A (en) * 2024-12-27 2025-01-28 北京京东远升科技有限公司 Driving control method, driving control device and intelligent driving vehicle

Also Published As

Publication number Publication date
TW202513370A (en) 2025-04-01

Similar Documents

Publication Publication Date Title
JP7766091B2 (en) Vehicle and method of operating said vehicle for performing minimal risk maneuvers
CN111284492B (en) Device and method for controlling the travel of a vehicle
JP7207256B2 (en) vehicle control system
CN112706763B (en) Vehicle and method of controlling the same
KR102660838B1 (en) Vehicle and method for controlling thereof
JP6404634B2 (en) Consistent behavior generation of predictive advanced driver assistance systems
CN105848981B (en) Driver assistance method and system for vehicle
TWI678305B (en) Automatic driving method and device with decision diagnosis
JP4207088B2 (en) Vehicle travel estimation device
JP6536852B2 (en) Vehicle control apparatus and vehicle control method
CN111907524B (en) Vehicle and control method thereof
CN112849159A (en) Vehicle control system and vehicle control method
JPH10181487A (en) Collision preventing device for vehicle
CN110271533A (en) Controller of vehicle
CN113453969A (en) Method for protecting a vehicle
JP2019043195A (en) Vehicle control device
CN117246317A (en) Vehicle performing minimum risk maneuvers and methods of operating the vehicle
TWI865064B (en) Minimum risk decision system and method for changing lane and non-transitory computer readable media
US20210053591A1 (en) Vehicle and method of controlling the same
KR20170070580A (en) Ecu, autonomous vehicle including the ecu, and method of controlling lane change for the same
JP2024052617A (en) Vehicle for performing minimal risk maneuvers and method of operating said vehicle
JP7566156B2 (en) How the vehicle operates during autonomous driving
KR102251575B1 (en) Rear collision avoidance system and method
JP7703004B2 (en) Lane change decision system and method, and non-transitory computer
JP2004237813A (en) Vehicle braking control device