PID与LQR在二级倒立摆控制中的对比研究

1. 项目概述

二级倒立摆系统是控制理论研究中极具挑战性的经典问题，它模拟了许多实际工程系统中的不稳定控制场景。作为一名从事控制系统研究多年的工程师，我经常将倒立摆系统作为验证新控制算法的测试平台。这次我决定对PID和LQR这两种经典控制方法进行系统性对比研究，希望能为同行们在类似系统的控制策略选择上提供一些实用参考。

二级倒立摆相比一级倒立摆，控制难度呈指数级增长。系统包含一个小车和两个相互连接的摆杆，需要通过控制小车的左右移动来保持两个摆杆同时直立不倒。这种系统具有典型的非线性、强耦合特性，而且由于存在两个自由度的摆杆，系统动态行为更加复杂多变。

2. 系统建模与假设

2.1 物理系统构成

我们的实验系统由以下核心部件组成：

• 直线导轨上的可移动小车（质量M）
• 第一级摆杆（质量m1，长度l1）
• 第二级摆杆（质量m2，长度l2）
• 电机驱动系统
• 角度和位置传感器

在实际建模前，我们需要做一些合理假设来简化问题：

1. 所有部件均为刚体，不考虑弹性变形
2. 忽略所有形式的摩擦（包括空气阻力、轴承摩擦等）
3. 电机响应理想，无延迟
4. 传感器测量精确无噪声

注意：这些假设虽然简化了建模过程，但也意味着我们的模型与真实物理系统存在差距。在实际应用中，需要考虑这些非理想因素的影响。

2.2 数学模型推导

使用拉格朗日力学方法建立系统动力学方程。定义系统状态变量为：

• 小车位置x
• 第一摆杆角度θ1（相对于垂直方向）
• 第二摆杆角度θ2（相对于第一摆杆）

系统的动能T包括：

• 小车平移动能
• 第一摆杆的平移和转动动能
• 第二摆杆的平移和转动动能

系统势能V主要来自两个摆杆的重力势能。通过拉格朗日方程L=T-V，我们可以得到系统的非线性微分方程。由于方程较为复杂，这里给出线性化后的状态空间表示：

code复制ẋ = Ax + Bu
y = Cx + Du

其中状态向量x=[x, ẋ, θ1, θ̇1, θ2, θ̇2]^T，控制输入u为施加在小车上的力。

3. 控制算法实现

3.1 PID控制器设计

PID控制器的设计关键在于三个参数的整定：

• 比例系数Kp：决定对当前误差的反应强度
• 积分系数Ki：消除稳态误差
• 微分系数Kd：提供阻尼，抑制振荡

对于