电赛小白也能搞定的旋转倒立摆：STM32 HAL库+双环PID实战避坑指南
第一次接触旋转倒立摆项目时，我被它优雅的力学特性和复杂的控制逻辑深深吸引。作为一个电赛新手，面对这个经典的控制系统题目，既兴奋又忐忑。本文将分享如何用STM32 HAL库和双环PID算法实现旋转倒立摆的全过程，重点解析那些容易踩坑的细节和调试技巧。
1. 硬件选型与搭建：从零开始的避坑指南
1.1 核心硬件选择
旋转倒立摆的硬件系统主要由三部分组成：
电机选型：必须选择带编码器的直流减速电机，这是实现位置闭环的关键。常见型号如JGA25-370，减速比建议在1:30到1:50之间。我曾尝试使用不带编码器的电机，结果完全无法建立有效的位置反馈。
角度传感器：推荐使用模拟输出的单轴角度传感器（如WDD35D4）。注意其量程要覆盖±90°，输出电压范围需匹配STM32的ADC输入。
驱动电路：TB6612是性价比很高的选择，但要注意其死区电压。实测发现，不同批次的芯片死区可能有10-20mV的差异。
1.2 机械结构搭建
机械稳定性往往被初学者忽视，却是项目成败的关键。两个典型结构方案对比：
| 结构类型 | 优点 | 缺点 | 适用场景 |
|---|---|---|---|
| 短轴电机 | 结构简单 | 易晃动 | 轻负载 |
| 长轴电机 | 稳定性好 | 成本高 | 重负载 |
提示：在电机轴和摆杆连接处加装轴承可以显著减少机械振动。我曾因忽略这点，调试三天无果，加上轴承后问题立刻解决。
2. 软件架构设计：双环PID的实现逻辑
2.1 控制环路分解
旋转倒立摆需要两个控制环协同工作：
内环（角度环）：快速响应摆杆角度变化
- 输入：角度传感器ADC值
- 输出：电机PWM占空比
- 特点：高带宽、快速响应
外环（位置环）：维持旋转臂位置稳定
- 输入：电机编码器脉冲
- 输出：角度环的目标角度修正
- 特点：低频、抗干扰
// 双环控制基本框架 void Control_Loop() { float angle = Get_Angle(); // 获取当前角度 int encoder = Read_Encoder(); // 获取编码器值 // 外环计算 float position_out = Position_PID(encoder); // 内环计算 float angle_out = Angle_PID(angle + position_out); Set_Motor(angle_out); // 输出控制 }2.2 ADC采样优化
角度传感器的ADC采样质量直接影响控制效果。推荐采用以下滤波组合：
- 硬件滤波：在传感器输出端添加RC低通滤波（截止频率约50Hz）
- 软件滤波：
- 移动平均滤波（窗口大小5-7）
- 限幅滤波（消除突发干扰）
#define FILTER_SIZE 5 uint16_t ADC_Filter(uint16_t raw) { static uint16_t buf[FILTER_SIZE]; static uint8_t index = 0; buf[index++] = raw; if(index >= FILTER_SIZE) index = 0; uint32_t sum = 0; for(int i=0; i<FILTER_SIZE; i++) { sum += buf[i]; } return sum / FILTER_SIZE; }3. PID参数整定：从理论到实践的跨越
3.1 角度环调试步骤
角度环是系统稳定的基础，调试顺序至关重要：
- 先调P再调D：将I参数设为0，逐步增大P直到系统出现等幅振荡
- 加入微分：D参数约为P的1/10，观察振荡是否衰减
- 微调I：少量I参数可消除静差，但过大会导致系统迟钝
典型参数范围参考：
| 参数 | 作用 | 典型值范围 | 调整技巧 |
|---|---|---|---|
| Kp | 响应速度 | 20-50 | 大到刚好出现振荡 |
| Ki | 消除静差 | 0.1-0.5 | 从0.01开始逐步增加 |
| Kd | 抑制振荡 | 2-5 | 观察超调量变化 |
3.2 位置环的特殊处理
位置环需要特别注意积分饱和问题。解决方案：
- 积分分离：当误差较大时关闭积分项
- 积分限幅：限制积分项的最大累积值
- 动态死区：根据角度调整电机死区补偿
// 改进的位置环PID实现 float Position_PID(float error) { static float integral = 0; static float last_error = 0; // 积分分离 if(fabs(error) > 50) { integral = 0; } else { integral += error; // 积分限幅 integral = constrain(integral, -300, 300); } float p = Kp * error; float i = Ki * integral; float d = Kd * (error - last_error); last_error = error; return p + i + d; }4. 调试工具与技巧：可视化带来的突破
4.1 VOFA+实时监控
串口数据可视化工具能极大提升调试效率。配置步骤：
- 在STM32端添加打印代码：
printf("%.2f,%.2f\n", angle, position);- VOFA+配置：
- 波特率：115200
- 数据格式：float,float
- 波形显示：双通道
注意：打印频率建议控制在100-200Hz，过高会影响控制周期。
4.2 典型问题诊断
常见故障现象及解决方法：
高频振荡：
- 检查机械结构是否松动
- 适当增大微分项
- 降低P参数
缓慢偏移：
- 检查角度传感器零点
- 增加少量积分项
- 确认编码器方向是否正确
响应迟钝：
- 增大P参数
- 检查控制周期是否过长
- 确认电机驱动电压足够
5. 进阶优化：从能用到好用的跨越
5.1 参数自适应策略
固定PID参数难以适应所有工况，可采用以下优化：
- 变参数PID：根据角度误差动态调整参数
// 变参数PID示例 if(fabs(error) < 10) { Kp = 30; Kd = 3; } else { Kp = 50; Kd = 5; }- 动态死区补偿：根据转向调整死区电压
void Set_Deadzone(int direction) { if(direction > 0) { dead_zone = 250; // 正向死区 } else { dead_zone = 300; // 反向死区 } }5.2 自动起摆算法
从静止状态自动起摆的实现要点：
- 能量累积阶段：左右摆动逐渐增大幅度
- 状态检测：当角度达到临界值时切换控制模式
- 平稳过渡：控制算法无缝切换
void Auto_Swing() { static int swing_count = 0; if(angle < 3750 && angle > 3630) { swing_count++; if(swing_count == 1) { direction = !direction; // 反转方向 } } if(direction) { motor_out = 2000; } else { motor_out = -2000; } // 达到平衡条件后切换模式 if(angle < aim_angle+300 && angle > aim_angle-300) { mode = BALANCE_MODE; } }调试这个项目最大的体会是：硬件是基础，软件是灵魂，耐心是关键。记得有一次调参到凌晨三点，当倒立摆终于稳稳立住的那一刻，所有的疲惫都化作了成就感。建议新手准备一个调试日志本，记录每次参数修改的效果，这会大大缩短调试周期。
)
