四轮转向车辆LQR控制与Simulink建模实践

1. 四轮转向车辆控制与LQR算法基础

四轮转向(4WS)系统通过前后轮协同转向显著提升车辆操纵稳定性，在高速变道时，传统前轮转向车辆容易出现横摆角速度振荡和质心侧偏角过大的问题。LQR(Linear Quadratic Regulator)作为最优控制理论中的经典方法，通过状态反馈矩阵计算最优控制量，特别适合处理这类多输入多输出的线性系统控制问题。

车辆动力学模型中，横摆角速度(γ)反映车辆绕垂直轴的旋转快慢，质心侧偏角(β)表征车辆实际运动方向与车头指向的偏离程度。在双移线工况下，这两个参数直接决定车辆轨迹跟踪精度和行驶稳定性。零质心侧偏角控制则是通过算法约束使β趋近于零，从而保证车辆始终沿车头指向运动。

关键提示：四轮转向控制的核心矛盾在于——后轮转向既能增强机动性（减小转弯半径），又可能引发振荡（过度转向）。LQR通过权重矩阵调节这对矛盾，这是仿真前必须理解的基础。

2. Simulink建模框架搭建

2.1 车辆动力学模型构建

采用二自由度自行车模型作为基础架构，包含：

matlab复制% 参数定义示例
m = 1575;       % 整车质量(kg)
Iz = 2875;      % 绕Z轴转动惯量(kg·m^2)
lf = 1.2;       % 前轴到质心距离(m)
lr = 1.6;       % 后轴到质心距离(m)
Cf = 80000;     % 前轮总侧偏刚度(N/rad)
Cr = 80000;     % 后轮总侧偏刚度(N/rad)

状态方程矩阵A和B的推导需考虑前后轮转向角δ_f、δ_r的共同影响：

code复制A = [-(Cf+Cr)/(m*Vx),  -(lf*Cf-lr*Cr)/(m*Vx^2)-1;
     -(lf*Cf-lr*Cr)/Iz, -(lf^2*Cf+lr^2*Cr)/(Iz*Vx)];
  
B = [Cf/(m*Vx), Cr/(m*Vx);
     lf*Cf/Iz,  -lr*Cr/Iz];

2.2 双移线工况生成

使用Signal Builder模块创建ISO标准双移线路径：

• 第一移线：3秒内横向位移3.5m
• 第二移线：6秒内返回原车道
• 车速保持80km/h恒定
  路径曲率通过Derivative模块实时计算，作为