车辆横摆稳定性控制：LQR、模糊PID与滑模控制联合仿真

1. 项目概述：车辆横摆稳定性控制系统的联合仿真实现

在车辆动力学控制领域，横摆稳定性控制一直是确保行车安全的核心技术。这个基于Carsim和Simulink联合仿真的项目，通过三种不同的控制算法（LQR、模糊PID和滑模控制）来实现对车辆横摆运动的精确控制。简单来说，就是当车辆在转弯或紧急避障时可能出现失控打滑的情况下，系统能够自动施加适当的纠正力矩，就像一双无形的手稳稳地扶住车身。

这个系统的独特之处在于它采用了双层控制架构：上层负责决策控制策略，下层处理力矩分配。上层控制器会根据车辆状态（如横摆角速度、质心侧偏角等）计算出需要的纠正力矩，下层控制器则将这些力矩合理地分配到四个车轮上。这种架构既保证了控制精度，又考虑了实际执行机构的限制。

2. 系统架构与工作原理

2.1 整体控制架构设计

整个系统采用分层式架构，分为上层决策层和下层执行层。上层控制器包含三种控制算法，根据不同的行驶工况自动切换：

1. LQR控制器：适合常规干燥路面，控制平稳精确
2. 模糊PID控制器：针对低附着系数路面（如雨雪天气），具有更好的适应性
3. 滑模控制器：用于极限工况，响应迅速但控制量较大

下层控制器采用基于二次规划的转矩分配算法，将上层计算得到的总驱动力和横摆力矩最优地分配到四个车轮。这种架构设计充分考虑了控制精度和实时性的平衡。

2.2 车辆动力学模型基础

系统以经典的线性二自由度车辆模型作为控制基准，该模型包含两个核心状态变量：

1. 横摆角速度(γ)：车辆绕垂直轴的旋转角速度
2. 质心侧偏角(β)：车辆速度方向与车身纵轴线的夹角

这两个参数共同决定了车辆的横向动力学特性。控制系统的目标就是使实际横摆角速度跟踪理想值，同时将质心侧偏角保持在安全范围内。

3. 上层控制算法实现细节

3.1 LQR控制器设计与调参

LQR（线性二次型调节器）控制的核心在于代价函数的设计：

J = ∫(xᵀQx + uᵀRu)dt

其中Q和R矩阵的选择直接影响控制效果。经过多次仿真测试，我们确定了以下经验性调参规则：

1. 低速工况（<50km/h）：
   Q = diag([500, 30]) # 侧重横摆角跟踪
   R = 0.2

2. 中速工况（50-80km/h）：
   Q = diag([800