LQR控制一阶倒立摆系统全解析与实践

1. LQR控制一阶倒立摆系统全解析

倒立摆作为控制理论中的经典研究对象，一直吸引着无数工程师和研究者的目光。记得我第一次接触倒立摆时，那种既兴奋又忐忑的心情至今难忘——兴奋于能亲手实现这个看似不可能稳定的系统，忐忑于背后复杂的数学原理和控制方法。经过多次实践和调试，我终于掌握了用LQR（线性二次调节器）控制一阶倒立摆的核心技术，现在将这些经验完整分享给大家。

1.1 系统特性与挑战

一阶倒立摆系统具有几个显著特征：

• 高阶次（四阶系统）
• 多变量（需要同时控制摆杆和旋转臂）
• 强非线性（特别是大角度摆动时）
• 自然不稳定（稍有不慎就会倒下）

这些特性使得传统PID控制虽然理论上可行，但实际调参非常困难。而LQR控制通过状态空间建模和优化方法，能够更系统地解决这些问题。下面我将从数学建模开始，逐步拆解整个控制过程。

2. 数学建模详解

2.1 拉格朗日动力学建模

建立准确的数学模型是控制的基础。我们采用拉格朗日方法，从能量角度推导系统动力学方程。

2.1.1 系统参数定义

首先明确系统各物理量：

• α：摆杆转角（rad）
• θ：旋转杆转角（rad）
• m：摆杆质量（kg）
• J：摆杆绕质心的转动惯量（kg·m²）
• I：旋转杆绕电机轴的转动惯量（kg·m²）
• l：摆杆质心到支点的距离（m）
• r：旋转杆的长度（m）

2.1.2 能量分析

系统动能T包括三部分：

1. 旋转杆转动动能：T_rot = (1/2)Iθ̇²
2. 摆杆转动动能：T_pend_rot = (1/2)Jα̇²
3. 摆杆平动动能：需要通过复合运动计算

摆杆质心速度平方：
v_p² = (θ̇r - lα̇cosα)² + (lα̇sinα)²
= θ̇²r² - 2rlθ̇α̇cosα + l²α̇²

系统势能V（以支点为零势能面）：
V = mglcosα

2.1.3 拉格朗日方程

拉格朗日函数L = T - V，对每个广义坐标应用拉格朗日方程：

d/dt(∂L/∂q̇) - ∂L/∂q = Q_nonconservative

经过推导（过程略，详见原文），得到两个非线性微分方程：

(I + mr²)θ̈ - mrlα̈ = - (K_mK_e/R)θ̇ + (K_m/R)u