本發(fā)明涉及輔助駕駛領域，特別涉及一種路徑規(guī)劃方法。

背景技術：

1、現(xiàn)階段，車輛在行駛過程中變道時，是不考慮待變道車道的周邊是否存在他車的。例如，自車在向右側(cè)的待變道車道變道時，若待變道車道的右側(cè)存在他車，自車在變道時容易與他車存在碰撞感，也即自車在變道時由于距離他車較近，這種情況下變道的危險性隨之提高，并且容易給駕駛員帶來壓迫感。因此，在待變道車道的周邊存在障礙物時，如何規(guī)劃更安全的變道路徑是目前有待解決的技術問題。

技術實現(xiàn)思路

1、有鑒于此，本發(fā)明的目的在于提供一種路徑規(guī)劃方法，能夠根據(jù)變道指令的指令類型、與障礙物相關的預期碰撞時間和第一碰撞危險程度系數(shù)判斷是否延遲變道，通過調(diào)整變道的時機以規(guī)劃更安全的變道路徑，從而降低車輛變道的危險性。其具體方案如下：

2、第一方面，本技術提供了一種路徑規(guī)劃方法，包括：

3、在基于變道指令確定的待變道車道以及相鄰車道上存在障礙物時，規(guī)劃針對所述待變道車道的初始變道路徑；

4、確定當前自車與所述障礙物之間的預期碰撞時間；

5、預測基于所述初始變道路徑進行變道時的第一碰撞危險程度系數(shù)；所述第一碰撞危險程度系數(shù)表征與所述障礙物之間發(fā)生碰撞的危險程度系數(shù)；

6、基于所述變道指令的指令類型、所述預期碰撞時間以及所述第一碰撞危險程度系數(shù)判斷是否延遲變道，并基于延遲變道判斷結(jié)果確定目標變道路徑，以根據(jù)所述目標變道路徑執(zhí)行相應的變道操作。

7、可選的，所述基于所述變道指令的指令類型、所述預期碰撞時間以及所述第一碰撞危險程度系數(shù)判斷是否延遲變道，包括：

8、若所述變道指令的指令類型為撥桿變道指令，或，所述變道指令的指令類型為自動變道指令且所述預期碰撞時間和所述第一碰撞危險程度系數(shù)不滿足預設碰撞條件，則判定立即變道；

9、若所述變道指令的指令類型為自動變道指令且所述預期碰撞時間和所述第一碰撞危險程度系數(shù)滿足預設碰撞條件，則判定延遲變道；

10、其中，所述預設碰撞條件包括所述預期碰撞時間小于預設時間且所述第一碰撞危險程度系數(shù)小于第一預設系數(shù)。

11、可選的，所述基于延遲變道判斷結(jié)果確定目標變道路徑，包括：

12、若所述延遲變道判斷結(jié)果表征延遲變道，則確定相應的延遲變道時間，并在經(jīng)過所述延遲變道時間后重新規(guī)劃變道路徑，以得到目標變道路徑；

13、若所述延遲變道判斷結(jié)果表征立即變道，且所述變道指令的指令類型為撥桿變道指令，則通過判斷所述預期碰撞時間和所述第一碰撞危險程度系數(shù)是否滿足預設碰撞條件，以確定是否對所述初始變道路徑進行優(yōu)化，得到目標變道路徑；

14、若所述延遲變道判斷結(jié)果表征立即變道，且所述變道指令的指令類型為自動變道指令，則將所述初始變道路徑確定為目標變道路徑。

15、可選的，所述通過判斷所述預期碰撞時間和所述第一碰撞危險程度系數(shù)是否滿足預設碰撞條件，以確定是否對所述初始變道路徑進行優(yōu)化，得到目標變道路徑，包括：

16、若所述預期碰撞時間和所述第一碰撞危險程度系數(shù)滿足預設碰撞條件，則基于所述初始變道路徑上的每個規(guī)劃點的第二碰撞危險程度系數(shù)和車輛橫向速度，對所述初始變道路徑進行優(yōu)化，以得到目標變道路徑；所述第二碰撞危險程度系數(shù)表征自車位于規(guī)劃點時與所述障礙物之間發(fā)生碰撞的危險程度系數(shù)；

17、若所述預期碰撞時間和所述第一碰撞危險程度系數(shù)不滿足預設碰撞條件，則將所述初始變道路徑確定為目標變道路徑。

18、可選的，所述基于所述初始變道路徑上的每個規(guī)劃點的第二碰撞危險程度系數(shù)和車輛橫向速度，對所述初始變道路徑進行優(yōu)化之前，還包括：

19、在以所述初始變道路徑上的任一規(guī)劃點為原點的目標坐標系下，獲取所述任一規(guī)劃點到所述障礙物的橫向距離，并基于所述任一規(guī)劃點與前一規(guī)劃點的位置，確定所述任一規(guī)劃點的車輛橫向速度；

20、基于所述任一規(guī)劃點到所述障礙物的橫向距離以及所述任一規(guī)劃點的車輛橫向速度，確定所述任一規(guī)劃點的第二碰撞危險程度系數(shù)；

21、其中，所述目標坐標系的縱軸方向平行于所述任一規(guī)劃點在車道中心線上的切線的方向；所述目標坐標系的橫軸方向垂直于所述切線的方向。

22、可選的，所述預測基于所述初始變道路徑進行變道時的第一碰撞危險程度系數(shù)，包括：

23、基于所述初始變道路徑上的預設時間段內(nèi)的規(guī)劃點的車輛橫向速度，確定第一平均橫向速度；所述預設時間段為與當前時刻相鄰的時間段；

24、根據(jù)所述初始變道路徑上的第一個規(guī)劃點到所述障礙物的橫向距離以及所述第一平均橫向速度，確定第一碰撞危險程度系數(shù)。

25、可選的，所述基于所述初始變道路徑上的每個規(guī)劃點的第二碰撞危險程度系數(shù)和車輛橫向速度，對所述初始變道路徑進行優(yōu)化，以得到目標變道路徑，包括：

26、從所述初始變道路徑中確定第二碰撞危險程度系數(shù)小于第二預設系數(shù)的目標規(guī)劃點；

27、基于所述目標規(guī)劃點的第二碰撞危險程度系數(shù)確定所述目標規(guī)劃點的第一代價值；

28、基于所述初始變道路徑上的每個規(guī)劃點的車輛橫向速度，確定所述初始變道路徑的第二代價值；

29、利用所述第一代價值和所述第二代價值，對所述初始變道路徑進行優(yōu)化，以得到目標變道路徑。

30、可選的，所述基于所述目標規(guī)劃點的第二碰撞危險程度系數(shù)確定所述目標規(guī)劃點的第一代價值，包括：

31、基于所述目標規(guī)劃點的第二碰撞危險程度系數(shù)和所述第二預設系數(shù)之間的差值，確定所述目標規(guī)劃點的第一代價值。

32、可選的，所述基于所述初始變道路徑上的每個規(guī)劃點的車輛橫向速度，確定所述初始變道路徑的第二代價值，包括：

33、從所述初始變道路徑上的每個規(guī)劃點的車輛橫向速度中，確定最大橫向速度；

34、基于所述目標規(guī)劃點的車輛橫向速度，確定第二平均橫向速度；

35、根據(jù)所述最大橫向速度和所述第二平均橫向速度，確定所述初始變道路徑的第二代價值。

36、可選的，所述確定相應的延遲變道時間，包括：

37、從所述初始變道路徑上的各所述目標規(guī)劃點對應的規(guī)劃時間中，確定最大規(guī)劃時間；

38、基于所述最大規(guī)劃時間確定所述延遲變道時間。

39、可選的，所述確定當前自車與所述障礙物之間的預期碰撞時間，包括：

40、確定前方目標到后方目標的縱向距離；所述前方目標和所述后方目標分別為當前自車與所述障礙物中位置靠前的一方和位置靠后的一方；

41、確定所述后方目標和所述前方目標的速度差；

42、基于所述縱向距離和所述速度差的比值以及所述比值的正負情況，確定預期碰撞時間。

43、第二方面，本技術提供了一種路徑規(guī)劃裝置，包括：

44、路徑規(guī)劃模塊，用于在基于變道指令確定的待變道車道以及相鄰車道上存在障礙物時，規(guī)劃針對所述待變道車道的初始變道路徑；

45、時間確定模塊，用于確定當前自車與所述障礙物之間的預期碰撞時間；

46、系數(shù)預測模塊，用于預測基于所述初始變道路徑進行變道時的第一碰撞危險程度系數(shù)；所述第一碰撞危險程度系數(shù)表征與所述障礙物之間發(fā)生碰撞的危險程度系數(shù)；

47、變道執(zhí)行模塊，用于基于所述變道指令的指令類型、所述預期碰撞時間以及所述第一碰撞危險程度系數(shù)判斷是否延遲變道，并基于延遲變道判斷結(jié)果確定目標變道路徑，以根據(jù)所述目標變道路徑執(zhí)行相應的變道操作。

48、第三方面，本技術提供了一種電子設備，包括：

49、存儲器，用于保存計算機程序；

50、處理器，用于執(zhí)行所述計算機程序以實現(xiàn)前述的路徑規(guī)劃方法。

51、第四方面，本技術提供了一種計算機可讀存儲介質(zhì)，用于保存計算機程序，所述計算機程序被處理器執(zhí)行時實現(xiàn)前述的路徑規(guī)劃方法。

52、本技術中，在基于變道指令確定的待變道車道以及相鄰車道上存在障礙物時，規(guī)劃針對所述待變道車道的初始變道路徑；確定當前自車與所述障礙物之間的預期碰撞時間；預測基于所述初始變道路徑進行變道時的第一碰撞危險程度系數(shù)；所述第一碰撞危險程度系數(shù)表征與所述障礙物之間發(fā)生碰撞的危險程度系數(shù)；基于所述變道指令的指令類型、所述預期碰撞時間以及所述第一碰撞危險程度系數(shù)判斷是否延遲變道，并基于延遲變道判斷結(jié)果確定目標變道路徑，以根據(jù)所述目標變道路徑執(zhí)行相應的變道操作。由此可見，本技術在待變道車道以及相鄰車道上存在障礙物時，根據(jù)變道指令的指令類型、與障礙物相關的預期碰撞時間和第一碰撞危險程度系數(shù)判斷是否需要延遲變道，以通過調(diào)整變道的時機來規(guī)劃更安全的目標變道路徑，從而降低自車沿著目標變道路徑進行變道時與障礙物發(fā)生碰撞的危險性，提高車輛行駛的安全性。