一種自動(dòng)駕駛車輛智能決策及局部軌跡規(guī)劃方法及其決策系統(tǒng)

基本信息

申請(qǐng)?zhí)?/td> CN202110756066.3 申請(qǐng)日 -
公開(kāi)(公告)號(hào) CN113386795B 公開(kāi)(公告)日 2022-07-01
申請(qǐng)公布號(hào) CN113386795B 申請(qǐng)公布日 2022-07-01
分類號(hào) B60W60/00(2020.01)I 分類 一般車輛;
發(fā)明人 蔣立偉;吳勇;檀生輝;王東;姜敏;陶振;伍旭東;吳二導(dǎo);孫鴻健;胡珍珠;何志維;齊紅青 申請(qǐng)(專利權(quán))人 西安電子科技大學(xué)蕪湖研究院
代理機(jī)構(gòu) 蕪湖思誠(chéng)知識(shí)產(chǎn)權(quán)代理有限公司 代理人 -
地址 241000安徽省蕪湖市弋江區(qū)文津西路8號(hào)
法律狀態(tài) -

摘要

摘要 本發(fā)明提供了一種自動(dòng)駕駛車輛智能決策及局部軌跡規(guī)劃方法及其決策系統(tǒng),方法包括下列步驟:步驟一、由道路信息采樣給定車輛當(dāng)前位置及給定的目標(biāo)位置點(diǎn);步驟二、通過(guò)Frenet坐標(biāo)系對(duì)軌跡計(jì)算進(jìn)行簡(jiǎn)化,利用多項(xiàng)式插值出車輛未來(lái)的遍歷軌跡對(duì)應(yīng)的路徑,通過(guò)汽車的初始狀態(tài)與目標(biāo)狀態(tài)求解軌跡集合;步驟三、對(duì)上述軌跡集合進(jìn)行成本代價(jià)評(píng)估并按最小原則排序,根據(jù)排序結(jié)果依次進(jìn)行是否滿足約束條件的檢查,直至確定同時(shí)滿足各約束條件的最優(yōu)軌跡;步驟四、獲得最優(yōu)軌跡后下發(fā)行車命令用于車輛運(yùn)動(dòng)控制。本發(fā)明將復(fù)雜的非線性軌跡規(guī)劃問(wèn)題簡(jiǎn)化,降低了軌跡規(guī)劃的難度,規(guī)劃出光滑、平順的軌跡,令車輛行駛更加平穩(wěn)。