1. 项目背景与核心挑战
在智能驾驶系统的开发过程中，横向控制算法是确保车辆稳定循迹的关键技术。双移线工况作为ISO标准测试场景之一，能够有效验证控制器在快速变道情况下的动态响应性能。这个项目通过Simulink搭建LQR控制器，与CarSim车辆动力学模型进行联合仿真，实现了在复杂工况下的精准路径跟踪。
传统PID控制在双移线工况下容易出现超调量大、收敛速度慢的问题。LQR（线性二次调节器）通过状态反馈实现多变量系统的最优控制，特别适合处理车辆横向动力学这类多输入多输出系统。但实际工程应用中存在三个主要难点：一是车辆模型参数辨识的准确性，二是权重矩阵Q和R的合理配置，三是实时性要求下的算法简化。
2. 系统架构设计解析
2.1 整体仿真框架
采用"控制器+车辆模型+场景"的三层架构：
code复制[Simulink LQR控制器] ←数据交互→ [CarSim车辆模型] ←场景输入→ [双移线路径]
信号交互通过CarSim S-Function接口实现，主要传输以下关键变量：
- 输入：横向偏差（m）、航向角偏差（rad）、车速（m/s）
- 输出：前轮转角（rad）、制动压力（MPa）
注意：CarSim的坐标系定义与Simulink可能存在差异，需在接口模块中做转换处理。实测发现忽略坐标系转换会导致控制量相位滞后约0.3秒。
2.2 车辆动力学模型简化
基于自行车模型建立状态空间方程：
code复制ẋ = Ax + Bu
y = Cx + Du
状态变量x选取：
code复制x = [横向偏差 航向角偏差 横摆角速度 侧偏角]^T
控制输入u为前轮转角δ。在CarSim中需关闭ESP等电子稳定程序，避免干扰控制效果验证。
3. LQR控制器实现细节
3.1 权重矩阵调参方法论
Q矩阵对角元素对应状态变量权重，建议初始值设置：
code复制Q = diag([10, 0.1, 0.01, 0.5])
R = 1
调参过程中发现三个关键规律：
- 横向偏差权重过大会导致方向盘抖动
- 航向角权重低于0.05时出现"蛇形走线"
- 车速60km/h时R值需增大到3以上保持稳定
3.2 离散化处理技巧
采用Tustin变换进行离散化，采样周期选择20ms。实测表明：
- 周期>50ms时会出现明显震荡
- 周期<10ms时CarSim实时交互可能丢帧
- 最优解算使用代数Riccati方程，避免迭代计算
4. CarSim联合仿真实操
4.1 接口配置关键步骤
- 在CarSim中导出VS Solver模板
- 修改vehicle_parameters.par文件中的轮胎模型参数
- Simulink侧配置S-Function采样时间为0.02s
- 设置数据记录触发条件（如横向偏差>0.2m）
4.2 典型问题排查记录
| 现象 | 原因分析 | 解决方案 |
|---|---|---|
| 车辆跑偏 | CarSim轮胎侧偏刚度与控制器模型不匹配 | 在par文件中将Cf/Cr调整为8e4/1e5 |
| 控制延迟 | 仿真步长不一致 | 统一设置为0.02s固定步长 |
| 数据跳变 | S-Function缓冲区溢出 | 增加OutputBufferSize到2048 |
5. 双移线工况测试结果
在80km/h车速下进行测试，关键指标对比如下：
| 指标 | PID控制 | LQR控制 |
|---|---|---|
| 最大横向误差(m) | 0.42 | 0.15 |
| 稳定时间(s) | 2.8 | 1.2 |
| 方向盘转角速率(deg/s) | 85 | 45 |
实测发现两个值得注意的现象：
- 当路径曲率突变时，LQR的预瞄特性使其超调量减少约60%
- 低附着路面（μ=0.3）下需将Q矩阵的侧偏角权重提高3倍
6. 工程化改进建议
- 增加前馈补偿：根据路径曲率提前计算稳态方向盘转角
- 参数自适应：基于车速在线调整Q/R矩阵
- 执行器保护：在Simulink中添加转向电机电流限制模块
- 加入故障检测：当CarSim通信中断超过100ms时触发安全模式
在实车测试阶段发现，转向系统机械间隙会导致高频抖动。解决方法是在LQR输出后增加二阶低通滤波器，截止频率设为8Hz。这个细节在仿真中往往被忽略，却是工程落地的关键。