二级倒立摆PID与LQR控制仿真对比分析

1. 项目背景与核心价值

倒立摆系统作为控制理论中的经典研究对象，一直被视为检验各类控制算法效果的"试金石"。而二级倒立摆更是将控制难度提升了一个数量级——它由两个相互铰接的摆杆组成，下摆杆通过电机驱动在水平轨道上移动，上摆杆则通过铰链与下摆杆相连。这种结构使得系统具有高度非线性、强耦合和天然不稳定的特性，对控制器的设计提出了极高要求。

在实际工程中，二级倒立摆的动力学特性与许多现实系统相似，比如火箭发射时的姿态控制、两轮平衡车的运动控制，甚至是人体行走时的平衡机制。通过研究二级倒立摆的控制问题，我们能够提炼出适用于更复杂系统的控制策略。这也是为什么在自动化、机器人等专业的研究生课程中，倒立摆控制常被列为必修实验项目。

本项目将针对二级倒立摆系统，分别采用经典的PID控制和现代的LQR控制两种方法进行稳定性控制仿真，通过对比分析它们在响应速度、抗干扰能力、参数调节复杂度等方面的表现，为实际控制系统设计提供参考依据。所有仿真将在MATLAB/Simulink环境下完成，确保结果的可复现性。

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

2.1 物理系统描述

我们的二级倒立摆系统由三个主要部分组成：可在水平轨道上移动的小车、与小车铰接的第一级摆杆（下摆杆），以及与下摆杆铰接的第二级摆杆（上摆杆）。系统输入为作用在小车上的水平力F，输出为小车位置x和两个摆杆的角度θ₁、θ₂。假设摆杆为刚性杆，铰接处无摩擦，系统参数定义如下：

• 小车质量：M = 1.5 kg
• 下摆杆质量：m₁ = 0.5 kg
• 上摆杆质量：m₂ = 0.3 kg
• 下摆杆长度：2l₁ = 0.6 m（杆中心到铰接点距离l₁=0.3m）
• 上摆杆长度：2l₂ = 0.4 m（杆中心到铰接点距离l₂=0.2m）

2.2 拉格朗日动力学建模

采用拉格朗日方程建立系统动力学模型是最常用的方法之一。我们定义系统的广义坐标为q = [x, θ₁, θ₂]ᵀ，则系统的动能T和势能V可表示为：

code复制T = 1/2*M*ẋ² + 1/2*m₁*(ẋ₁² + ż₁²) + 1/2*m₂*(ẋ₂² + ż₂²)
V = m₁*g*z₁ + m₂*g*z₂

其中(ẋ₁, ż₁)和(ẋ₂, ż₂)分别是下摆杆和上摆杆质心的速度分量，可通过几何关系表示为θ₁和θ₂的函数。将这些表达式代入拉格朗日方程：

code复制d/dt(∂L/∂q̇) - ∂L/∂q = Q

其中L = T - V为拉格朗日量，Q为广义力（在本系统中只有小车受到外力F）。经过一系列推导（具体过程见补充材料），我们得到系统的非线性动力学方程：

code复制(M + m₁ + m₂)ẍ - (m₁l₁ + m₂L₁)C₁θ̈₁ - m₂l₂C₂θ̈₂ + (m₁l₁ + m₂L₁)S₁θ̇₁² + m₂l₂S₂θ̇₂² = F
-(m₁l₁ + m₂L₁)C₁ẍ + (I₁ + m₁l₁² + m₂L₁²)θ̈₁ + m₂L₁l₂C₁₂θ̈₂ - (m₁l₁ + m₂L₁)gS₁ - m₂L₁l₂S₁₂θ̇₂² = 0
-m₂l₂C₂ẍ + m₂L₁l₂C₁₂θ̈₁ + (I₂ + m₂l₂²)θ̈₂ - m₂gl₂S₂ + m₂L₁l₂S₁₂θ̇