025、PID控制器的嵌入式优化：避免浮点运算

025 PID控制器的嵌入式优化：避免浮点运算

从一次电机抖动的深夜调试说起

去年做一款四轴机械臂的关节伺服驱动，STM32F405主控，12位ADC采样电流，PWM频率20kHz。PID算出来电机在低速运行时总有一种细微的“颗粒感”，像齿轮缺了油。示波器抓电流波形，发现每几百个周期会出现一个异常的尖峰。排查了三天，最后定位到问题——浮点运算的精度和速度在实时中断里打架了。

那个晚上我盯着反汇编窗口，看到编译器生成的浮点乘法指令后面跟了一堆取整和舍入的代码，突然意识到：在嵌入式实时系统里，浮点不是“慢一点”的问题，而是“不确定”的问题。从那以后，我的PID代码里就再没见过float或double。

浮点运算在MCU上的真实代价

很多工程师觉得“F4有FPU啊，浮点很快”。没错，单精度浮点乘法确实只要几个周期。但问题出在三个地方：

第一，中断延迟的不确定性。浮点运算的寄存器上下文保存和恢复，比整数重得多。当你的PID在定时器中断里跑，浮点指令可能被更高优先级的中断打断，保存/恢复FPU寄存器的时间抖动会直接反映在控制周期上。我实测过，同样的PID算法，浮点版本的中断响应抖动比定点版本大了3-5倍。

第二，编译器优化不可控。你写个kp * error，编译器可能生成FMUL指令，也可能生成调用软浮点库的代码，取决于优化等级和芯片型号。这种不确定性在量产时可能翻车——换个批次芯片，浮点单元有细微差异，控制效果就变了。