Simulink四轮转向仿真：PID与LQR控制对比分析

1. 项目概述

四轮转向技术作为车辆动力学控制领域的重要研究方向，其核心价值在于通过后轮主动转向来提升车辆操纵稳定性。这次我们用Simulink搭建了完整的四轮转向（4WS）与前轮转向（2WS）对比仿真平台，重点分析了双车道切换和蛇形绕桩两种典型工况下的车辆动态响应差异。

这个项目的独特之处在于：

• 实现了纯Simulink环境下的完整车辆动力学模型
• 对比测试了传统PID与现代LQR两种控制策略
• 发现了四轮转向在不同工况下的反直觉特性
• 完整开源了模型文件和说明文档

提示：所有仿真模型和说明文档已开源，文末附获取方式。建议先阅读说明文档第四章的故障树分析，可以少走很多弯路。

2. 模型架构设计

2.1 基础车辆模型

我们采用经典的二自由度自行车模型作为基础架构，主要参数包括：

• 整车质量：1450kg
• 轴距：2.7m
• 前/后轮侧偏刚度：-60000N/rad
• 横摆转动惯量：2500kg·m²

matlab复制% 车辆参数结构体定义
vehicle.m = 1450;       % 质量(kg)
vehicle.lf = 1.5;       % 前轴到质心距离(m)
vehicle.lr = 1.2;       % 后轴到质心距离(m)
vehicle.Cf = 60000;     % 前轮侧偏刚度(N/rad)
vehicle.Cr = 60000;     % 后轮侧偏刚度(N/rad)
vehicle.Iz = 2500;      % 横摆转动惯量(kg·m²)

2.2 转向系统实现

前轮转向模型直接将方向盘转角映射到前轮：

code复制δf = K_steer * θ_wheel

而四轮转向系统增加了后轮转角计算模块，核心是后轮转角比例系数k：

code复制δr = k * δf

在实际调试中发现：

• k=0.3时车辆稳定性最佳
• k>0.5会导致过度转向
• 低速时k值应适当减小（建议0.1-0.2）

3. 控制策略实现

3.1 PID控制器设计

PID控制器的核心代码如下，重点处理了横摆角速度(r)和侧偏角(β)的组合误差：

matlab复制function delta_r = pid_controller(vx, vy, r)
    Kp = 0.8;  % 比例系数
    Ki = 0.05; % 积分系数 
    Kd = 0.12; % 微分系数
    
    persistent integral error_prev
    if isempty(integral)
        integral = 0;
        error_prev = 0; 
    end
    
    error = 0.6*r - 0.4*vy;  % 组合误差
    integral = integral + error*0.01;
    derivative = (error - error_prev)/0.01;
    
    delta_r = Kp*error + Ki*integral + Kd*derivative;
    error_prev = error;
end

调试心得：

1. 积分项必须加限幅（建议±0.3rad）
2. 高速工况下应降低Ki值
3. 蛇形工况Kp值可适当增大

3.2 LQR控制器设计

LQR控制需要先建立状态空间方程：

code复制ẋ = Ax + Bu
y = Cx + Du

我们选择的状态变量：

• 横摆角速度 r
• 侧偏角 β
• 转向角变化率 δ̇

权重矩阵经过多次调试确定为：

code复制Q = diag([15, 10, 5]);  % 状态权重
R = 0.1;               % 控制权重

求解Riccati方程得到最优反馈矩阵K后，控制律为：

code复制δr = -K*x

4. 仿真结果分析

4.1 双车道切换工况

4.2 蛇形绕桩工况

5. 关键技术难点

5.1 执行机构延迟补偿

转向执行机构存在约50ms的延迟，解决方案：

1. 加入死区补偿模块
2. 输出端添加二阶滤波器：

   matlab复制G = tf([1],[0.02^2 2*0.7*0.02 1]);
   

3. 限制最大转向速率为45deg/s

5.2 不同路面适应性

在低附着系数路面（μ=0.3）测试发现：

• PID控制更鲁棒
• LQR性能下降约40%
• 建议实现控制策略切换逻辑：

  code复制if μ < 0.5
      启用PID模式
  else
      启用LQR模式
  end
  

6. 模型获取与使用建议

完整Simulink模型包含：

• 前轮转向基准模型
• 四轮转向PID控制版本
• 四轮转向LQR控制版本
• 两种测试工况场景

使用前必读：

1. 确保MATLAB版本≥R2019b
2. 先运行init_params.m加载参数
3. 调整采样时间为0.001s
4. 建议从低速工况开始测试

我在实际调试中发现一个隐藏技巧：在Simulink的Solver设置中将类型改为ode23t，可以显著改善高速工况下的数值稳定性。另外，模型中的轮胎子系统其实预留了Pacejka魔术公式接口，有兴趣的同行可以尝试扩展非线性轮胎模型。