别再手动调PWM了！用STM32F103的PID速度环，让你的直流电机稳如老狗
STM32F103 PID速度环实战：让直流电机无视负载波动的终极方案
当你的智能小车在上坡时突然减速，或是机械臂关节因负载变化而颤抖，那种无力感就像看着精心调教的PWM参数瞬间失效。作为经历过无数次深夜调参的工程师，我深知手动调节PWM占空比的局限性——它就像试图用固定油门应对复杂路况。本文将带你用STM32F103构建真正的PID速度闭环系统，让电机转速如同被无形之手稳定控制，无论负载如何变化。
1. 从开环到闭环：控制思维的范式转移
许多开发者习惯用PWM直接控制电机转速，这就像蒙眼驾驶——无法感知实际速度，更谈不上精确控制。闭环控制的核心在于反馈-比较-调节的持续循环：
开环控制痛点：
- 负载变化导致速度波动（典型场景：上坡/下坡）
- 电池电压下降时转速不稳定
- 需要针对不同工况手动调整PWM
闭环优势对比表：
特性 开环控制 PID闭环控制 抗干扰能力 弱 强 参数调整 经验性调整 系统性调参 稳态误差 不可避免 可消除 适用场景 固定负载 动态变化环境
关键认知：闭环系统不是简单地在代码里添加PID公式，而是建立完整的"感知-决策-执行"链条。码盘反馈相当于系统的"眼睛"，PID算法则是"大脑"。
2. 硬件架构设计：从码盘到PWM的完整链路
一个可靠的测速系统是PID控制的前提。常见方案中，20线光电码盘+红外对管组合性价比最高：
// 码盘计数中断配置示例（TIM3） void TIM3_IRQHandler(void) { if (TIM_GetITStatus(TIM3, TIM_IT_Update) == SET) { float num = CountSensor_Get(); speed = num/20.0f; // 每转20脉冲，计算RPS(转/秒) printf("Speed: %.3f rps\r\n", speed); TIM_ClearITPendingBit(TIM3, TIM_IT_Update); } }关键硬件参数选择：
- 码盘分辨率：20线/转平衡了精度与处理开销
- 采样周期：推荐50-100ms（太长会滞后，太短增加噪声）
- PWM频率：STM32的TIM2输出建议8-10kHz（避免电机啸叫）
实测技巧：用示波器观察PWM波形时，注意死区时间设置。我曾因未配置死区导致MOS管直通烧毁驱动芯片，教训深刻。
3. PID工程实现：从理论到稳健代码
PID算法在嵌入式端的实现需要特别注意数值处理和实时性。以下是经过实战检验的结构体设计：
typedef struct { float Kp, Ki, Kd; // 参数 float SetPoint; // 目标转速(rps) float ProcessVariable; // 实际转速 float ErrorSum; // 积分项累加 float LastError; // 上次误差 float Output; // PWM输出值 float OutMax, OutMin; // 输出限幅 } PIDController; void PID_Init(PIDController *pid, float kp, float ki, float kd) { pid->Kp = kp; pid->Ki = ki; pid->Kd = kd; pid->ErrorSum = 0; pid->OutMax = 100.0f; // 对应PWM最大值 pid->OutMin = 0.0f; } float PID_Calculate(PIDController *pid, float pv) { float error = pid->SetPoint - pv; pid->ErrorSum += error; // 抗积分饱和处理 if(pid->ErrorSum > pid->OutMax) pid->ErrorSum = pid->OutMax; else if(pid->ErrorSum < pid->OutMin) pid->ErrorSum = pid->OutMin; float derivative = error - pid->LastError; pid->Output = pid->Kp * error + pid->Ki * pid->ErrorSum + pid->Kd * derivative; // 输出限幅 if(pid->Output > pid->OutMax) pid->Output = pid->OutMax; else if(pid->Output < pid->OutMin) pid->Output = pid->OutMin; pid->LastError = error; return pid->Output; }代码中的工程经验：
- 输出限幅：防止积分项累积导致PWM超限
- 抗饱和处理：避免长时间误差累积
- 浮点运算：STM32F103没有FPU，但简单PID运算足够
4. 参数整定实战：从混沌到稳定
PID调参是门艺术，但有其科学方法。推荐采用"先P后I最后D"的阶梯法：
纯P控制：逐步增大Kp直到系统开始振荡
- 现象观察：转速开始有规律地上下波动
- 记录临界值：如Kp=0.5时出现振荡
加入积分：取Kp的50%作为初始值，逐步增加Ki
- 目标消除静差（如目标2.5rps实际2.3rps）
- 典型值：Ki = 0.1~0.3 * Kp
微调微分：D项能抑制超调但增加噪声敏感度
- 从Kd=0.01开始尝试
- 过大的Kd会导致电机"抽搐"
调试数据记录表：
| 参数组 | Kp | Ki | Kd | 超调量 | 调节时间 | 稳态误差 |
|---|---|---|---|---|---|---|
| 1 | 0.3 | 0 | 0 | 无 | >2s | 0.2rps |
| 2 | 0.5 | 0.1 | 0 | 15% | 1.5s | 0.05rps |
| 3 | 0.4 | 0.08 | 0.01 | 5% | 0.8s | <0.01rps |
调参秘诀：在电机轴上加装指针和刻度盘，直接观察转速变化比看串口数据更直观。我曾用这种方法半小时调出理想参数。
5. 异常处理与性能优化
即使参数调好，现实环境仍会带来各种挑战：
码盘抖动：添加低通滤波
// 移动平均滤波示例 #define FILTER_WINDOW 5 float speed_filter_buf[FILTER_WINDOW]; float apply_filter(float new_val) { static int index = 0; speed_filter_buf[index++] = new_val; if(index >= FILTER_WINDOW) index = 0; float sum = 0; for(int i=0; i<FILTER_WINDOW; i++) { sum += speed_filter_buf[i]; } return sum / FILTER_WINDOW; }突发负载：增加微分项权重
电池电压波动：根据电压动态调整PWM基准
PID进阶技巧：
- 变积分系数：误差大时禁用积分，避免windup
- 设定值滤波：避免目标速度突变导致超调
- 串级PID：外环速度+内环电流控制（更高阶方案）
6. 真实项目中的教训与收获
在去年开发的AGV项目中，我们遇到了电机偶尔"发疯"的问题——明明负载稳定却突然加速。最终发现是码盘信号线未做屏蔽，被变频器干扰。解决方案：
- 改用双绞屏蔽线
- 在GPIO口添加100nF电容
- 软件上增加突变值丢弃逻辑
另一个常见问题是上电瞬间的"突跳"现象。通过在PID初始化时设置：
pid->ProcessVariable = 0; // 假设初始速度为0 pid->Output = 20; // 初始PWM输出(根据电机特性调整)这些经验无法从教科书获得，却能让你的PID系统真正可靠工作。当看到电机在突然加重500g负载后仅用0.3秒恢复设定转速时，那种成就感远超调通一个简单PWM驱动。