二级倒立摆控制系统：PID与LQR控制策略对比

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

在控制工程领域，二级倒立摆系统一直被视为检验控制算法性能的"试金石"。这个看似简单的物理系统——由小车和两根铰接的摆杆组成——却蕴含着令人着迷的控制难题。当我第一次在实验室见到这个系统时，那两根倔强地试图摆脱控制的摆杆给我留下了深刻印象。

二级倒立摆本质上是一个多变量、强耦合的非线性系统。与单级倒立摆相比，它的控制难度呈指数级增长。系统具有以下典型特征：

• 高阶不稳定性：系统有四个不稳定极点
• 强非线性：摆杆角度与控制系统输出呈现复杂的非线性关系
• 多变量耦合：小车位置与两个摆杆角度相互影响
• 欠驱动特性：仅通过小车一个输入要控制三个输出变量

在实际工程中，类似二级倒立摆的动态特性广泛存在于各种应用中。例如双足机器人的步态控制、火箭发射时的姿态稳定，甚至金融市场的动态平衡等，都可以抽象为类似的倒立摆问题。这也是为什么掌握二级倒立摆控制技术对控制工程师如此重要。

2. 系统建模与动力学分析

2.1 物理系统假设与简化

建立精确的数学模型是控制系统设计的基础。为了在理论分析与工程可实现性之间取得平衡，我们做出以下合理假设：

1. 刚体假设：所有组件（小车、摆杆1、摆杆2）均为理想刚体，不考虑弹性变形
2. 理想驱动：电机驱动力直接且无延迟地作用于小车
3. 摩擦忽略：忽略库伦摩擦、粘滞摩擦等所有摩擦力
4. 空气阻力忽略：不考虑空气动力学影响

这些假设虽然使模型与真实物理系统存在差异，但能抓住系统的主要动态特性，同时保持模型的数学可处理性。

2.2 拉格朗日动力学建模

采用拉格朗日方法建立系统动力学方程，这是处理复杂多体系统的有效手段。系统动能T包括：

• 小车平移动能
• 摆杆1的平移动能和转动动能
• 摆杆2的平移动能和转动动能

系统势能V主要来自摆杆的重力势能。通过定义广义坐标q=[x,θ₁,θ₂]ᵀ（小车位移、摆杆1角度、摆杆2角度），可以导出完整的系统动力学方程。

在实际推导过程中，有几个关键点需要注意：

1. 摆杆质心位置的确定需要考虑两级摆杆的耦合关系
2. 动能计算时需要考虑科里奥利力和离心力项
3. 势能表达式要准确反映高度变化

最终得到的非线性微分方程可以通过在工作点附近线性化，转换为状态空间形式：

ẋ = Ax +