基於多點預瞄最優控制的智能車輛路徑跟蹤
http://www.cnki.com.cn/Article/CJFDTotal-QCJS201810003.htm
文檔位置:
https://drive.wps.cn/view/p/28719853679?from=docs&source=docsWeb
文章整理:
2.2 道路預瞄模型
圖2(a)所示的為文獻[8]所使用的道路預瞄模型,以道路在局部坐標系下的未來n 個周期的參考y 軸方向橫向偏移作為道路狀態量,當前車輛在局部坐標系中的橫向坐標為y,朝向角為 ψ ,假設車輛縱向速度u 恆定,當前車輛坐標為 y,第一個道路狀態量即為 yr0,第二個狀態量即車輛沿 x 軸方向移動 uT 后,對應的道路 y 坐標,即為圖中的yr1,以此類推再下一周期同樣x向移動uT,狀態量變為yr2,yr3,yrn。
此模型采用的局部坐標系方向固定不變,車體坐標 系與局部坐標系夾角位置關系隨着車輛運動不斷變化, 當車輛朝向角與x 軸夾角過大時,車輛的每一時刻x 向參考位置的變化將與uT 差別較大,使得算法對於這種情況的適應性較差。因此本文的局部坐標系直接采用車體坐標系作為參考,車輛的初始y 向坐標為0,航向角ψ也為0,這樣車輛沿x 軸的參考位置uT 對應橫向參考坐標隨着車體坐標系的不斷變化而不斷變化,縱向速度假設更加合理,算法適應性更強。