直线一级倒立摆PID控制建模与仿真实践

1. 直线一级倒立摆的物理模型构建

直线一级倒立摆系统由移动小车和单摆杆组成，是经典的控制理论研究对象。这个看似简单的系统却蕴含着丰富的动力学特性，能够很好地验证控制算法的有效性。

1.1 系统组成与基本假设

系统主要包含三个关键部件：

1. 可水平移动的小车（质量M）
2. 通过无摩擦铰链连接的摆杆（质量m，长度2l）
3. 驱动小车的执行机构（通常为电机）

为简化建模过程，我们做出以下合理假设：

• 摆杆为刚性杆件，不考虑弹性变形
• 铰链处无摩擦且无质量
• 小车运动时仅受水平方向的驱动力
• 系统运行环境无空气阻力等外部干扰

1.2 坐标系定义与参数说明

建立如图所示的坐标系：

• 水平向右为x轴正方向
• 垂直向上为y轴正方向
• 摆角θ定义为摆杆与垂直向上方向的夹角（顺时针为正）

系统参数定义：

• 小车质量：M = 0.5 kg
• 摆杆质量：m = 0.2 kg
• 摆杆长度：2l = 0.6 m
• 重力加速度：g = 9.81 m/s²
• 小车位置：x
• 摆杆角度：θ

1.3 动力学方程推导

采用拉格朗日方程推导系统动力学模型。首先建立系统的动能T和势能V：

系统总动能：
T = 小车动能 + 摆杆动能
= ½Mẋ² + ½m(v_x² + v_y²)

其中摆杆质心的速度分量：
v_x = ẋ + lθ̇cosθ
v_y = -lθ̇sinθ

系统势能：
V = mglcosθ

拉格朗日函数：
L = T - V

应用拉格朗日方程：
d/dt(∂L/∂q̇) - ∂L/∂q = F

对x和θ分别求导，得到非线性微分方程组：
(M+m)ẍ + mlθ̈cosθ - mlθ̇²sinθ = F
mlẍcosθ + (4/3)ml²θ̈ - mglsinθ = 0

1.4 线性化处理

在平衡位置（θ≈0）附近进行线性化处理：
sinθ ≈ θ，cosθ ≈ 1，θ̇² ≈ 0

得到线性化方程：
(M+m)ẍ + mlθ̈ = F
mlẍ + (4/3)ml²θ̈ - mglθ = 0

整理为矩阵形式：
⎡M+m ml ⎤ ⎡ẍ⎤ = ⎡F⎤
⎣ ml 4/3ml²⎦ ⎣θ̈⎦ ⎣0⎦

解这个方程组可以得到状态空间表达式，为后续控制器设计奠定基础。

2.