1、总体结构
控制系统结构图:

黑色块为参数、黄色块为计算模块
1.1 其中参数含义
- 车辆属性参数:
| 参数 | 含义 | 
|---|---|
| C α f C_{\alpha f} Cαf | 自行车模型总轮胎侧偏刚度(前轮) | 
| C α r C_{\alpha r} Cαr | 自行车模型总轮胎侧偏刚度(后轮) | 
| I I I | yaw轴转动惯量 | 
| a a a | 重心到前轴距离 | 
| b b b | 重心到后轮距离 | 
| m m m | 簧上质量+簧下质量 | 
- 车辆状态参数:
| 参数 | 含义 | 
|---|---|
| v x , v y v_x,v_y vx,vy | 横向,纵向速度 | 
| x , y x,y x,y | 横纵坐标 | 
| ϕ \phi ϕ | 车身横摆角 | 
| θ r \theta_r θr | 投影点切线夹角 | 
| k r k_r kr | 投影点位置曲线曲率 | 
1.2 中间量含义
| 中间量 | 含义 | 
|---|---|
| A,B | 是车辆动力学方程中,状态量和控制量的系数,由车辆属性参数和车速决定 | 
| e r r e_{rr} err | 误差向量,包括横向、纵向、横摆角误差及其导数 | 
| k k k | 实际就是 k r k_r kr | 
| K K K | LQR的输出量:Ricati方程的解及A,B参数构成的一个系数矩阵 |