旋转倒立摆PID调参实战：从电机死区到积分分离的避坑全记录
第一次看到旋转倒立摆在电赛题目中出现时，我天真地以为只要套用经典PID公式就能轻松搞定。直到亲手调试时才发现，从电机死区补偿到积分分离策略，每个环节都暗藏玄机。这篇文章将分享我在STM32平台上调试倒立摆时遇到的七个典型问题及其解决方案，特别适合正在被PID参数折磨的开发者参考。
1. 硬件配置的隐形陷阱
调试PID前，硬件稳定性往往被低估。我的第一个教训来自一台"跳舞"的倒立摆——电机轴抖动导致所有软件调参徒劳无功。
1.1 电机选型的血泪教训
- 短轴vs长轴电机：短轴电机在高速旋转时更容易引发机械共振，最终选用60mm轴长的直流减速电机（带AB相编码器）
- 死区电压实测：用示波器捕获到电机启动电压阈值为2.1V（对应PWM值约680），这个值必须写入控制函数：
#define DEAD_ZONE 680 // TB6612驱动芯片实测死区 void Set_Pwm(int motor) { if(motor > 0) motor += DEAD_ZONE; else if(motor < 0) motor -= DEAD_ZONE; __HAL_TIM_SET_COMPARE(&htim2, CHANNEL_1, abs(motor)); }1.2 传感器安装的魔鬼细节
角位移传感器的固定方式直接影响ADC采样稳定性。最初用热熔胶固定导致数据漂移，改用3D打印支架配合减震胶垫后，采样波动范围从±15LSB降至±3LSB。
提示：硬件安装完成后，先运行纯数据采集程序观察各传感器原始值波动情况，这是后续软件滤波的基础。
2. 直立环的诡异加速现象
当直立环单独工作时，最令人困惑的现象是摆杆会逐渐加速旋转直至失控。这其实是经典PID在非线性系统中的典型表现。
2.1 变参数KP的解决方案
传统固定KP值在摆角较大时控制力不足，我采用分段线性KP策略：
float Gray_KP; if(bias > -850 && bias < 0) { Gray_KP = 0.5*((-(1.5/1500)*abs_bias)+29.7); } else { Gray_KP = 0.5*((-(1.5/1500)*abs_bias)+29.8); }2.2 微分项的滤波处理
原始微分项对噪声极其敏感，加入一阶低通滤波后效果显著改善：
float alpha = 0.2; // 滤波系数 float filtered_deriv = alpha*(current_error - last_error) + (1-alpha)*last_deriv;3. 位置环的积分灾难
当加入位置环后，系统突然变得"神经质"——要么反应迟钝，要么剧烈振荡。核心问题出在积分项积累。
3.1 积分分离的实战应用
采用条件积分策略，仅在误差较小时启用积分：
if(abs(velocity_err) > 5) { integral_active = 0; integral_term = 0; } else { integral_active = 1; integral_term += velocity_err * ki; }3.2 动态积分限幅方案
固定积分限幅值难以适应不同工况，改为基于误差的自适应限幅：
| 误差范围 | 积分限幅值 | 适用场景 |
|---|---|---|
| <5° | ±300 | 精细调节 |
| 5°-15° | ±150 | 过渡区 |
| >15° | ±50 | 大幅偏差 |
4. 双环耦合的调参顺序
直立环与位置环存在强耦合，错误的调参顺序会导致反复折腾。我的有效调参流程：
- 先调直立环：仅保留P和D参数，目标是在手动扶正后能维持3-5秒不倒
- 再调速度环：加入位置环的P参数，观察旋转速度是否趋于稳定
- 最后调积分：逐步增加ki值，配合积分分离策略消除静差
注意：每次只调整一个参数，改变量不超过前值的20%，并用手机慢动作视频记录每次参数变化后的系统响应。
5. 硬件抖动对参数的致命影响
机械振动会通过三个途径影响控制系统：
- 传感器噪声放大微分项效应
- 电机齿槽转矩导致周期性扰动
- 结构共振引发正反馈
解决方案矩阵：
| 问题类型 | 软件手段 | 硬件改进 |
|---|---|---|
| 高频噪声 | 卡尔曼滤波 | 增加橡胶垫片 |
| 中频扰动 | 陷波滤波器 | 改进联轴器 |
| 低频摆动 | 前馈补偿 | 加重底座 |
6. 自动起摆的参数切换策略
从下垂状态到倒立保持需要截然不同的参数组，采用状态机实现平滑过渡：
typedef enum { STARTUP, SWING_UP, BALANCE } State; State current_state = STARTUP; void ControlLoop() { switch(current_state) { case STARTUP: if(angle > 30°) current_state = SWING_UP; break; case SWING_UP: if(angle > 165°) current_state = BALANCE; ApplySwingAlgorithm(); break; case BALANCE: RunBalancePID(); break; } }7. 调试工具链的实战配置
高效的调试离不开合适的工具组合：
- VOFA+：实时绘制PID各分量曲线
- 配置方法：通过串口发送格式化数据
printf("$%f,%f,%f#", KP*error, integral_term, KD*derivative); - STM32CubeMonitor：监控CPU负载和内存使用
- 手机慢动作摄影：240fps拍摄分析机械振动
在最终参数稳定后，记得进行温度老化测试——电机发热后参数漂移可能导致系统性能下降约15%，需要预留调整余量。
