二级倒立摆控制系统：建模、控制算法与工程实现

1. 二级倒立摆控制系统的工程挑战

二级倒立摆系统作为控制理论研究的经典对象，本质上是一个具有两个自由度的机械装置：底部的小车可以在水平轨道上移动，通过铰链连接的两级摆杆则可以在垂直平面内自由摆动。这个看似简单的物理系统却蕴含着丰富的控制理论问题，主要体现在以下几个方面：

• 本质不稳定性：当摆杆处于垂直向上的位置时，系统处于不稳定的平衡点。任何微小的扰动都会导致摆杆迅速倒下，这与单级倒立摆相比，稳定性控制难度呈指数级增长。

• 强非线性特性：系统的动力学方程包含sin/cos等非线性项，特别是在大角度摆动时，线性化近似会失效。我在实验室实测中发现，当摆杆角度超过15°时，线性控制器的性能会显著下降。

• 多变量耦合：小车位置、一级摆杆角度和二级摆杆角度这三个被控量之间存在复杂的动态耦合。例如调整小车位置会影响两个摆杆的角度，而摆杆的摆动又会反作用于小车位置。

• 实时性要求：由于系统的快速发散特性，控制算法必须在毫秒级时间内完成状态采集、计算和控制输出。我们团队在实际部署时，控制周期必须控制在5ms以内才能保证系统稳定。

2. 系统建模与参数辨识

2.1 拉格朗日动力学建模

采用拉格朗日方法建立系统动力学模型时，需要特别注意以下几点：

1. 广义坐标选择：我们选取小车位移x、一级摆杆角度θ₁和二级摆杆角度θ₂作为广义坐标。在实际建模过程中，我发现将二级摆杆角度定义为相对于一级摆杆的相对角度（θ₂'=θ₂-θ₁）可以简化动能计算。

2. 动能计算：

   • 小车动能：T_cart = 0.5Mẋ²
   • 一级摆杆动能包含平动和转动两部分：

     matlab复制% MATLAB代码示例：一级摆杆动能计算
     v1_x = x_dot + 0.5*l1*theta1_dot*cos(theta1);
     v1_y = 0.5*l1*theta1_dot*sin(theta1);
     T1 = 0.5*m1*(v1_x^2 + v1_y^2) + 0.5*I1*theta1_dot^2;
     

   • 二级摆杆动能计算更为复杂，需要考虑两级摆杆运动的叠加效应。

3. 势能计算：

   • 一级摆杆势能：V1 = m