直线一级倒立摆系统建模与PID控制实现

1. 直线一级倒立摆系统概述

直线一级倒立摆作为经典的控制理论教学案例，本质上是一个高度不稳定的非线性系统。它由可水平移动的小车和顶端自由旋转的摆杆组成，看起来就像杂技演员用一根木棍顶在手掌上保持平衡的场景。我在实验室第一次接触这个装置时，最直观的感受就是——只要小车移动稍有延迟，摆杆就会立刻倒下。

这个系统的核心挑战在于：我们需要通过控制小车的左右移动，来抵消摆杆因重力产生的倾倒趋势。从控制理论角度看，这涉及到：

• 欠驱动系统（小车是唯一执行机构）
• 非最小相位系统（初始响应与稳态响应方向相反）
• 强非线性（摆角超过5°后线性模型严重失真）

实际调试中发现：当摆杆初始角度超过30°时，常规PID控制基本失效。这也是为什么大多数实验都限定在±20°范围内操作。

2. 系统动力学建模详解

2.1 物理模型建立

我们先在SolidWorks中建立三维模型（图1），主要参数包括：

• 小车质量 M = 0.5 kg
• 摆杆质量 m = 0.2 kg
• 摆杆长度 l = 0.3 m
• 摆杆转动惯量 I = (1/3)ml²
• 小车摩擦系数 b = 0.1 N/m/s

2.2 拉格朗日方程推导

采用拉格朗日力学方法建立动力学方程，比牛顿力学更系统化：

1. 定义系统动能T：

   • 小车动能：0.5Mẋ²
   • 摆杆平移动能：0.5m(ẋ + lθ̇cosθ)² + 0.5m(-lθ̇sinθ)²
   • 摆杆转动动能：0.5Iθ̇²

2. 系统势能V：

   • 只有摆杆具有势能：V = mglcosθ

3. 拉格朗日量L = T - V

4. 对x和θ分别应用拉格朗日方程：

   math复制\frac{d}{dt}(\frac{∂L}{∂\dot{q}}) - \frac{∂L}{∂q} = Q
   

经过推导得到非线性微分方程组：

code复制(M+m)ẍ + mlθ̈cosθ - mlθ̇²sinθ + bẋ = F
mlẍcosθ + (I+ml²)θ̈ - mglsinθ = 0

2.3 线性化处理

在平衡点(θ=0)附近进行泰勒展开，保留一