STM32倒立摆PID控制实战：从原理到实现

1. 倒立摆控制系统概述

倒立摆作为经典的控制系统教学实验平台，本质上是一个自然不稳定系统。我第一次接触这个项目是在大三的控制理论课上，当时用实验室的老旧设备调试了整整两周才勉强实现10秒的平衡。如今基于STM32和MATLAB的工具链已经让这个实验的门槛大幅降低。

从物理结构来看，倒立摆系统通常由以下几个核心组件构成：

• 直线导轨或旋转臂（提供单自由度运动）
• 摆杆（长度通常在20-50cm之间）
• 直流电机（带编码器反馈）
• 驱动电路（H桥或现成驱动模块）
• 控制板（STM32F4系列性价比最高）

经验提示：实验室环境下建议选择旋转式倒立摆，机械结构更简单，对电机扭矩要求也更低。我们团队实测发现，使用JGA25-370直流减速电机（12V/30RPM）配合20cm摆杆就能满足基础实验需求。

2. 核心控制算法解析

2.1 PID控制原理精要

PID控制器的离散化实现公式看似简单：

code复制u(k) = Kp*e(k) + Ki*∑e(j) + Kd*(e(k)-e(k-1))

但在倒立摆系统中，三个环节的作用尤为特殊：

• 比例项（P）：主要响应摆杆的角度偏差。角度每偏离垂直位置1°，我们的测试数据显示需要约0.5V的电机驱动电压补偿
• 积分项（I）：消除系统稳态误差。实际调试中发现积分时间常数设为0.5秒时效果最佳
• 微分项（D）：抑制角度变化率。微分增益过大会导致电机高频抖动，建议初始值设为P项的1/5

2.2 参数整定实战技巧

通过MATLAB仿真得出的参数往往需要现场微调，这里分享我的参数调节四步法：

1. 先调P项：从小到大增加，直到系统出现等幅振荡
2. 记录临界增益Ku和振荡周期Tu
3. 按Ziegler-Nichols法则设置初始参数：
   • Kp = 0.6*Ku
   • Ki = Kp/(0.5*Tu)
   • Kd = Kp0.125Tu
4. 现场微调：优先降低高频抖动，再优化响应速度

避坑指南：调试时一定要固定采样周期！我们团队曾因从10ms改为5ms导致系统失稳，后来发现是微分项计算未同步调整Δt参数。

3. STM32实现方案详解

3.1 硬件配置清单

推荐以下高性价比方案（总成本<300元）：

3.2 软件架构设计

中断服务程序配置要点：

c复制// 定时器6配置为1kHz控制频率
TIM_TimeBaseInitTypeDef TIM_InitStruct;
TIM_InitStruct.TIM_Prescaler = 84-1; // 84MHz/84=1MHz
TIM_InitStruct.TIM_Period = 1000-1;  // 1MHz/1000=1kHz
TIM_TimeBaseInit(TIM6, &TIM_InitStruct);

// PID计算放在定时器中断中
void TIM6_DAC_IRQHandler() {
    static float last_error = 0, integral = 0;
    float error = target_angle - current_angle;
    integral += error * dt;
    float derivative = (error - last_error) / dt;
    output = Kp*error + Ki*integral + Kd*derivative;
    last_error = error;
    set_motor(output);
}

4. MATLAB仿真与代码生成

4.1 Simulink建模要点

搭建模型时特别注意：

1. 摆杆动力学方程建模：

   matlab复制function dxdt = pendulumDynamics(theta, dtheta, V)
       g = 9.8; L = 0.2; m = 0.05; b = 0.001;
       dxdt = [dtheta; 
               (m*g*L*sin(theta) - b*dtheta + Kt*V)/(m*L^2)];
   end
   

2. 加入电机死区补偿模块（实测约±0.3V）
3. 配置Fixed-Step求解器，步长与硬件保持一致

4.2 自动代码生成配置

关键配置步骤：

1. 在Model Settings中选择STM32硬件支持包
2. 配置代码生成选项：
   • Solver Type: Fixed-step
   • System target file: ert.tlc
   • Language: C
3. 生成后检查ert_main.c中的调度逻辑

经验之谈：生成的代码会占用约25KB Flash空间，建议关闭Math库的浮点打印功能节省资源。我们项目实测发现这能减少8%的代码体积。

5. 调试问题全记录

5.1 典型故障现象库

5.2 示波器调试技巧

1. 同时捕获：
   • 角度传感器原始值（ADC通道）
   • PID输出（PWM占空比）
   • 电机电流（采样电阻电压）
2. 重点关注：
   • 阶跃响应的超调量（应<15%）
   • 调节时间（目标<0.5秒）
   • 稳态误差（应<0.5°）

6. 进阶优化方向

对于想提升性能的开发者，可以考虑：

1. 状态空间控制：建立全状态反馈，加入速度环
2. 模糊PID：根据误差大小动态调整参数
3. 能量控制法：基于Lyapunov函数的非线性控制
4. 无线监控：通过HC-05蓝牙模块传输实时数据

我们团队在省赛获奖方案中，采用互补滤波融合MPU6050和编码器数据，将平衡精度提升到了±0.3°。具体做法是将陀螺仪积分与角度测量值按0.98:0.02的比例融合，有效抑制了传感器漂移。