四自由度半车模型主动悬架PID与LQG控制仿真

1. 项目背景与核心价值

汽车悬架系统作为连接车身与车轮的关键部件，直接影响着车辆的乘坐舒适性和操纵稳定性。传统被动悬架由于参数固定，难以兼顾不同路况下的性能需求。而主动悬架通过实时调节阻尼力或弹簧刚度，能够显著提升车辆动态性能。

这个项目聚焦于四自由度半车模型的主动悬架控制，通过建立精确的数学模型，并应用PID和LQG两种经典控制算法进行仿真验证。这种简化模型既保留了整车的主要动态特性，又降低了仿真计算复杂度，非常适合控制算法的快速验证和性能对比。

提示：四自由度模型相比常见的二自由度（1/4车）模型，增加了前后悬架的耦合作用，更接近真实车辆的俯仰运动特性。

2. 系统建模与参数设定

2.1 四自由度半车模型构建

我们建立的模型包含以下自由度：

• 车身垂直位移（z_s）
• 车身俯仰角（θ）
• 前轮垂直位移（z_uf）
• 后轮垂直位移（z_ur）

模型参数设置参考某B级轿车数据：

matlab复制ms = 1200;    % 车身质量(kg)
mus_f = 40;   % 前轮非簧载质量(kg)  
mus_r = 35;   % 后轮非簧载质量(kg)
Iyy = 2100;   % 俯仰转动惯量(kg·m²)
ks_f = 25000; % 前悬架刚度(N/m)
ks_r = 22000; % 后悬架刚度(N/m)
kt = 190000;  % 轮胎刚度(N/m)
a = 1.4;      % 前轴到质心距离(m)
b = 1.6;      % 后轴到质心距离(m)

2.2 状态空间方程推导

基于牛顿第二定律和力矩平衡原理，建立系统动力学方程：

1. 车身垂直运动：
   $$m_s\ddot{z}s = F + F_{sr}$$

2. 车身俯仰运动：
   $$I_{yy}\ddot{\theta} = aF_{sf} - bF_{sr}$$

3. 前轮垂直运动：
   $$m_{usf}\ddot{z}{uf} = -F + k_t(z_{rf}-z_{uf})$$

4. 后轮垂直运动：
   $$m_{usr}\ddot{z}{ur} = -F + k_t(z_{rr}-z_{ur})$$

其中悬架力$F_{sf}$、$F_{sr