二级倒立摆PID与LQR控制算法对比与实践

1. 二级倒立摆控制系统的工程实践解析

在控制工程领域，二级倒立摆系统堪称检验控制算法的"试金石"。这个看似简单的物理系统实则蕴含着丰富的控制理论挑战——它同时具备非线性、强耦合、多变量和不稳定等特性，与火箭姿态控制、双足机器人平衡等实际问题有着相似的动力学本质。本文将结合MATLAB仿真实践，深入剖析PID与LQR两种典型控制策略在该系统中的表现差异。

二级倒立摆的物理构型包含三个主要部件：水平移动的小车、通过转轴连接的一级摆杆和二级摆杆。当系统处于倒立平衡位置时，整个系统的势能处于局部极大值点，任何微小扰动都会导致系统失稳。这种特性使得它成为验证控制算法鲁棒性的理想平台。在实际工程中，类似动态特性的系统比比皆是，例如高速列车的摆式车厢控制、航天器的多级燃料箱液体晃动抑制等。

2. 系统动力学建模与线性化处理

2.1 拉格朗日方程建模实践

建立精确的数学模型是控制设计的基础。我们采用拉格朗日力学方法，通过系统的动能和势能表达式来推导运动方程。设小车质量为M=0.5kg，一级摆杆质量m1=0.2kg、长度l1=0.3m，二级摆杆质量m2=0.1kg、长度l2=0.25m。在忽略摩擦和空气阻力的假设下，系统的拉格朗日量L=T-V可表示为：

matlab复制syms x theta1 theta2 dx dtheta1 dtheta2 M m1 m2 l1 l2 g
T = 0.5*M*dx^2 + 0.5*m1*( (dx+l1*dtheta1*cos(theta1))^2 + (l1*dtheta1*sin(theta1))^2 ) + ...
    0.5*m2*( (dx+l1*dtheta1*cos(theta1)+l2*dtheta2*cos(theta2))^2 + (l1*dtheta1*sin(theta1)+l2*dtheta2*sin(theta2))^2 );
V = m1*g*l1*cos(theta1) + m2*g*(l1*cos(theta1)+l2*cos(theta2));
L = T - V;

2.2 工作点线性化技巧

由于原始模型包含sin/cos等非线性项，我们需要在平衡位置(θ1=0, θ2=0)进行线性化处理。采用小角度假设（sinθ≈θ，cosθ≈1），并忽略高阶小