1. 旋转倒立摆系统概述
旋转倒立摆作为经典的控制系统实验平台，本质上是一个高度非线性的不稳定系统。它由一个可旋转的基座和自由摆动的摆杆组成，摆杆通过铰链连接在旋转臂末端。这个看似简单的机械结构，却蕴含着丰富的控制理论挑战。
在实际操作中，我经常用"试图用一根手指平衡一根直立扫帚"来类比这个系统。就像扫帚会因重力作用而倾倒一样，倒立摆的摆杆也始终处于不稳定平衡点附近。我们的控制目标就是通过精确调节旋转臂的角度，抵消摆杆的倾倒趋势，使其保持直立状态。
这个系统之所以具有研究价值，主要体现在三个方面：首先，它的动力学特性与火箭姿态控制、两轮平衡车等实际工程问题高度相似；其次，系统对控制算法的鲁棒性和实时性要求极高；最后，它能够直观展示各种控制策略的效果差异。
2. 系统建模与动力学分析
2.1 拉格朗日方程建模
建立准确的数学模型是控制系统设计的基础。我通常采用拉格朗日方法推导系统动力学方程，相比牛顿力学方法，这种方法在处理多自由度系统时更为简便。具体推导过程如下：
首先定义系统变量：
- 旋转臂角度θ（控制输入）
- 摆杆角度α（被控输出）
- 旋转臂长度L
- 摆杆长度l
- 旋转臂质量M
- 摆杆质量m
拉格朗日函数L=T-V，其中T为系统动能，V为势能。经过推导可得系统的非线性微分方程：
(M + m)r²θ̈ + mlrcos(α)α̈ - mlrsin(α)α̇² = τ
mlrcos(α)θ̈ + (ml² + I)α̈ - mglsin(α) = 0
其中τ为电机转矩，I为摆杆转动惯量。
2.2 线性化处理
由于非线性方程难以直接用于控制器设计，我通常在平衡点(α=0)附近进行线性化处理。通过小角度假设(sinα≈α, cosα≈1, α̇²≈0)，得到线性化模型：
(M + m)r²θ̈ + mlrα̈ = τ
mlrθ̈ + (ml² + I)α̈ - mglα = 0
这个简化模型在摆杆偏离角度较小时(<15°)具有足够精度，为后续控制器设计奠定了基础。
3. 控制策略设计与实现
3.1 PID控制器设计
PID控制作为最经典的控制方法，是我首先尝试的方案。其控制律为：
τ = Kpe + Ki∫edt + Kd*de/dt
其中e=α_ref - α为角度误差。在倒立摆系统中，我通常只使用PD控制，因为积分项容易导致系统振荡。
参数整定技巧：
- 先调Kp使系统能够响应但不稳定
- 再调Kd抑制振荡
- 最后微调两者平衡响应速度与稳定性
实测经验：对于典型实验室倒立摆(M=0.5kg, m=0.2kg, l=0.3m)，初始参数可设为Kp=10, Kd=2。
3.2 全状态反馈控制
基于线性化模型，我设计全状态反馈控制器。首先将系统表示为状态空间形式：
ẋ = Ax + Bu
y = Cx
其中状态向量x=[θ, α, θ̇, α̇]ᵀ。通过极点配置法确定反馈增益K，使闭环系统具有期望的动态特性。
关键步骤：
- 验证系统能控性
- 选择期望极点位置（建议：两个主导极点对应ωn≈3rad/s, ζ≈0.7）
- 使用place或acker函数计算K
实际调试中发现，摆杆角度权重应比旋转臂角度高5-10倍，才能获得良好平衡效果。
3.3 模糊逻辑控制
针对系统非线性特性，我设计了双输入单输出的模糊控制器：
- 输入1：摆杆角度误差e（NB,NS,Z,PS,PB）
- 输入2：角度误差变化率ec（同e）
- 输出：控制量u（同e）
隶属度函数采用三角形分布，控制规则表基于专家经验建立。实测表明，模糊控制在较大角度偏移时表现优于PID，但稳态精度稍差。
4. Matlab/Simulink实现
4.1 Simulink建模
我的典型仿真模型包含以下关键部分：
- 非线性plant模型（使用S-function实现）
- 控制器模块（PID/状态反馈/模糊逻辑）
- 扰动注入点
- 数据记录和可视化
特别提醒：仿真步长应≤0.001s以保证数值稳定性，使用ode4(Runge-Kutta)求解器。
4.2 代码实现要点
状态反馈控制器核心代码示例：
matlab复制% 系统参数
M = 0.5; m = 0.2; l = 0.3; g = 9.81;
% 状态空间矩阵
A = [0 0 1 0;
0 0 0 1;
0 -m*g/M 0 0;
0 (M+m)*g/(M*l) 0 0];
B = [0;0;1/M;-1/(M*l)];
C = [0 1 0 0];
D = 0;
% 极点配置
poles = [-3+4i -3-4i -10 -12];
K = place(A,B,poles);
% 闭环系统
sys_cl = ss(A-B*K,B,C,D);
4.3 仿真结果分析
通过对比三种控制策略的阶跃响应，我发现：
- PID控制实现简单但抗扰性差
- 状态反馈响应快但依赖精确模型
- 模糊控制鲁棒性强但稳态误差大
在实际项目中，我常采用模糊PID混合控制，在小误差范围内使用PID，大误差时切换到模糊控制。
5. 硬件实现与调试技巧
5.1 实验平台搭建
典型旋转倒立摆硬件组成：
- 直流伺服电机（带编码器）
- 摆杆机构（建议碳纤维材料）
- 电机驱动器（如H桥电路）
- 实时控制器（如STM32）
关键安装提示：
- 确保旋转轴严格垂直
- 编码器分辨率≥1000PPR
- 电机扭矩需足够（≥0.5Nm）
5.2 实际调试经验
在实验室调试中，我总结了以下实用技巧：
- 先用手动方式找到平衡点，记录此时编码器值
- 初始测试时，可以用手轻轻扶住摆杆
- 参数调整应小步进行，每次只改一个参数
- 注意观察电机是否饱和，及时调整控制量限幅
常见问题排查：
- 系统持续振荡→增加微分增益
- 响应迟缓→适当提高比例增益
- 出现稳态误差→引入小积分项
6. 性能优化与扩展
6.1 抗扰性增强
通过添加扰动观测器，我显著提升了系统抗干扰能力。设计步骤：
- 建立扰动模型
- 设计降阶观测器
- 在控制律中加入扰动补偿项
实测表明，这种方法可使系统在0.5N·m扰动下仍保持稳定。
6.2 自适应控制
针对参数不确定性，我实现了模型参考自适应控制(MRAC)。核心思想是通过自适应律实时调整控制器参数，使系统跟踪参考模型输出。
6.3 多摆杆扩展
将系统扩展为双摆杆后，控制难度显著增加。我的解决方案：
- 采用分层控制结构
- 上层控制外摆杆
- 下层控制内摆杆
- 使用LQR方法协调控制
这种结构虽然复杂，但成功实现了双摆杆的稳定控制。