智慧汽車規劃控制常用控制方法詳解

控制是驅使車輛前進的策略。控制的目標是使用可行的控制量，最大限度地降低與目標軌蹟的偏差、最大限度地提供乘客的舒適度等。

如上圖所示，與控制模組輸入相關聯的模組有規劃模組、定位模組和車輛資訊等。其中定位模組提供車輛的位置信息，規劃模組提供目標軌跡信息，車輛信息則包括檔位、速度、加速度等。控制輸出量則為轉向、加速和煞車量。

控制模組主要分為橫向控制和縱向控制，根據耦合形式的差異可以分為獨立和一體化兩種方法。

1 控制方法

1.1 解耦控制

所謂解耦控制，就是將橫向和縱向控制方法獨立分開控制。

1.2 耦合控制

耦合控制考慮到了橫縱向控制時存在的耦合問題。一個典型的例子是汽車不能高速過彎，因為當縱向速度過高時，橫向角速度需要有一定的限制，否則向心力無法滿足向心加速度。

橫縱一體的典型代表方法是線性時變模型預測控制，該方法在模型預測控制的基礎上增加橫縱向的聯合約束。如最大向心加速度約束等。

1.3 橫向控制

#如上圖橫向控制可以分為幾何方法、基於運動學模型方法和基於動力學模型的方法。

1.3.1 前饋控制

#所謂前饋控制，即根據追蹤點資訊對控制量進行提前適當的補償。一個典型的例子是利用追蹤序列點中的曲率訊息，對轉角進行補償。

1.3.2 Chained Form

#鍊式系統將非線性系統進行多層線性化，它將系統逐層分解，進而可以將系統快慢化，類似濾波系統[3]。

系統在frenet座標下的模型：

##經過反向積分預算，可以得到控制率：

1.3.3 Lyapunov

基於李雅普諾夫穩定性方法的設計可以運用在運動學和動力學模型上。其基本思想是先建立運動學或動力學模型，根據模型提出追蹤方法，然後建立李雅普諾夫函數，透過李雅普諾夫穩定性證明閉環系統的漸近穩定[4]。

• 運動學模型

#如上圖所示，小車目前點為P，追蹤目標點為Pr。 是目前位置和目標點的位姿差，  和  分別為參考速度和角速度。設計李雅普諾夫函數：

追蹤率設計：

##追蹤率設計：

最後透過限定約束設計參數，進而證明了追蹤率的漸進穩定性，即當→ ∞時，  → 0。

動力學模型

#首先建立動力學模型：

其中：

##則誤差為：

設計代價函數：

設計控制率：

最終證明漸進穩定性。

######1.3.4 Pure Pursuit#############純粹追蹤是幾何路徑追蹤控制器。此控制器使用車輛運動和參考路徑的幾何關係來追蹤參考路徑的控制器。此控制方法使用車輛後軸中心作為參考點。 #####################根據上圖可推到出前輪轉角指令：################# ####其中R為轉彎半徑，L為車輛軸距，e為車輛當前姿態和目標路點在橫向上的誤差， 為前視距離且 。 #####################根據上圖實驗數據所示前視距離增加，追蹤抖動越來越小。較短的前視距離可提供更精確的跟踪，而較長的前視距離可提供更平滑的跟踪。 PurePursuit的另一個特徵是，在轉彎追蹤時，過大的前視距離會導致「cutting corners」。 Pure Pursuit很難在穩定性和追蹤性能之間進行權衡。 ######

1.3.5 Stanley

與以後軸為參考點的純追趕純追蹤方法不同，Stanley控制器先前軸為參考點。它同時考慮了航向誤差和橫向誤差。 Stanley控制器不僅考慮航向誤差，而且還考慮了橫向誤差。

根據上圖可推到出前輪轉角指令：

根據上圖實驗數據所示隨著k的增加，追蹤效能也會提高。當車速變大時Stanley不像Pure Pursuit有足夠的穩定性。

1.3.6 LQR

#基於車輛運動學模型的方法忽略了車輛的動力學特性，因此在車速過快或曲率變化率過大的情況下此演算法無法滿足車輛的穩定性控制要求。對於基於車輛動力學模型的控制方法，首要的工作是對車輛動力學進行建模。由於精確的二自由度動力學模型是非線性的，為了方便進行即時的追蹤控制計算，通常還需要在精確的二自由度動力學模型基礎上進行一些簡化近似，得到線性二自由度動力學模型。

• 車輛二自由度動力模型：

• LQR:

線性二次調節器（Linear Quadratic Regulator或LQR）是基於模型的控制器，它使用車輛的狀態來使誤差最小化。 LQR理論是現代控制理論中發展最早也最成熟的一種狀態空間設計法。 LQR可得到狀態線性回授的最適控制規律，易於構成閉迴路最適控制。

LQR 最優設計是指設計出的狀態回授控制器K 要讓二次型目標函數J 取最小值，而K 由權矩陣Q 與R 唯一決定，故此Q、R的選擇尤其重要。如下公式為LQR代價函數：

根據車輛動力學模型與LQR代價函數可以推到出代數里卡提方程式：

最終透過迭代黎卡提方程式計算回饋矩陣，再根據回饋矩陣取得最佳控制量。

1.3.7 MPC

#MPC(Model Prediction Control)是一種致力於將更長時間跨度,甚至於無窮時間的最優化控制問題, 分解為若干個更短時間跨度,或者有限時間跨度的最優化控制問題, 並且在一定程度上仍然追求最優解。

MPC由下列三個要素組成:

1. 預測模型: 預測模型能夠在短時間內很好的預測系統狀態的變化;
2. 線上滾動優化: 由於預測模型得到的結果與實際仍然存在偏差, 所以採用滾動優化找到每個時刻下的局部最優解,通常情況會設計一個目標(損失)函數並將其轉化為二次規劃問題進而找到最優解;
3. 回饋校正: 到下一個時間點根據新的狀態重新進行預測和最佳化。

• 預測模型:

#根據LQR中的車輛動力學模型可以推出預測模型。

• #滾動最佳化:

MPC代價函數：

根據預測模型、車輛橫向限制、代價函數進行最佳化求解可以得到對應的控制指令。

1.3.8 橫向控制演算法比較

1.4 縱向

#如上圖所示，縱向控制一般採用採用串級pid控制方法。

2 詳細設計

#控制器的設計如上圖所示，其中Controller為基底類，LonController、LonController和MPCController繼承該基底類別。 LonController又衍生出LQRController、LyapunovController和StanleyController等子類別。

以上是智慧汽車規劃控制常用控制方法詳解的詳細內容。更多資訊請關注PHP中文網其他相關文章！