从RC电路到C代码：一阶低通滤波器的前世今生，及其在STM32电机FOC控制中的落地
从RC电路到C代码：一阶低通滤波器的前世今生，及其在STM32电机FOC控制中的落地
在电机控制领域，特别是FOC（磁场定向控制）系统中，我们经常会遇到一个看似简单却蕴含深意的代码片段：y(k) = (1-a)*y(k-1) + a*x(k)。这个不起眼的公式背后，隐藏着从模拟电路到数字世界的精妙转换，以及控制工程师们对信号处理的深刻理解。本文将带您穿越物理与数字的边界，揭示这个一阶低通数字滤波器的完整生命历程。
1. 模拟世界的基石：RC低通滤波器
任何数字信号处理的起点都是物理世界。在电子学中，一阶RC低通滤波器是最基础的模拟滤波器之一，由电阻(R)和电容(C)组成。这个简单电路的行为可以用微分方程描述：
τ·dy/dt + y(t) = x(t)其中τ=RC是电路的时间常数。这个方程告诉我们：输出电压的变化率与当前状态共同决定了系统行为。
关键参数关系表：
| 参数 | 物理意义 | 计算公式 |
|---|---|---|
| τ | 时间常数 | RC |
| f_H | 截止频率 | 1/(2πRC) |
| 响应时间 | 达到稳态的63%所需时间 | τ |
提示：截止频率f_H是滤波器允许通过信号的边界频率，在此频率点信号幅度衰减为-3dB（约70.7%）
2. 从连续到离散：数字化的艺术
将模拟滤波器转换为数字形式需要离散化技术。后向差分法是一种常用的方法，它将微分近似为差分：
dy/dt ≈ (y(k) - y(k-1))/T其中T是采样周期。将这个近似代入原微分方程，经过整理就得到了我们的目标公式：
y[k] = (1 - a) * y[k-1] + a * x[k]系数a的物理意义：
- 当a→0：系统"记忆"很强，几乎忽略新输入
- 当a→1：系统几乎无记忆，直接跟随输入
- 典型值：a = 2πf_H/f_s（f_s为采样频率）
3. FOC系统中的实战应用
在STM32实现的电机FOC控制中，这个滤波器至少有三个关键应用场景：
- 相电流滤波：消除PWM开关噪声
- 反电势观测：提取干净的反电动势信号
- 角度/转速滤波：平滑估算结果
典型实现代码（STM32 HAL库）：
// 滤波器结构体定义 typedef struct { float alpha; // 滤波系数a float prev_out; // 上一次输出y[k-1] } LPF_1stOrder; // 初始化滤波器 void LPF_Init(LPF_1stOrder* filter, float alpha) { filter->alpha = alpha; filter->prev_out = 0.0f; } // 执行滤波 float LPF_Update(LPF_1stOrder* filter, float input) { filter->prev_out = (1 - filter->alpha) * filter->prev_out + filter->alpha * input; return filter->prev_out; } // 在PWM中断中的使用示例 void HAL_TIM_PWM_PulseFinishedCallback(TIM_HandleTypeDef *htim) { static LPF_1stOrder current_filter; float raw_current = ADC_GetCurrentReading(); float filtered_current = LPF_Update(¤t_filter, raw_current); // ...后续FOC算法处理 }注意：在中断服务函数中实现时，要确保数据类型和运算效率满足实时性要求
4. 参数设计与性能权衡
滤波器设计本质上是在响应速度和平滑度之间寻找平衡。在电机控制中，这个权衡尤为关键：
不同应用场景的参数选择：
| 应用场景 | 典型截止频率 | 考虑因素 |
|---|---|---|
| 相电流滤波 | 500Hz-2kHz | 需保留基波，滤除PWM噪声 |
| 反电势滤波 | 50-200Hz | 取决于电机转速范围 |
| 转速滤波 | 10-50Hz | 机械系统响应较慢 |
定点数优化技巧： 对于资源受限的MCU，可以采用定点数运算提高效率：
// 定点数实现（Q15格式） #define ALPHA_Q15 (int16_t)(0.157 * 32768) // a=0.157 int16_t LPF_FixedPoint(int16_t input, int16_t prev_out) { int32_t temp = (32768 - ALPHA_Q15) * (int32_t)prev_out; temp += ALPHA_Q15 * (int32_t)input; return (int16_t)(temp >> 15); }5. 进阶话题：多滤波器级联与非线性变参数
在要求更高的应用中，可以考虑：
- 级联滤波：多个一阶滤波器串联，获得更陡峭的滚降
- 变参数滤波：根据电机运行状态动态调整a值
- 抗饱和处理：防止长时间输入饱和导致输出"卡住"
// 变参数滤波器实现示例 void LPF_AdaptiveUpdate(LPF_1stOrder* filter, float input, float speed_rpm) { // 根据转速动态调整截止频率 float base_fH = 100.0f; // 基础截止频率 float adaptive_fH = base_fH * (1 + fabs(speed_rpm)/3000.0f); filter->alpha = 2 * PI * adaptive_fH / SAMPLE_FREQ; // 常规更新 filter->prev_out = (1 - filter->alpha) * filter->prev_out + filter->alpha * input; }在电机启动阶段，可以适当提高截止频率以获得更快响应；在稳态运行时降低截止频率以获得更好滤波效果。这种自适应策略在实际项目中能显著提升系统性能。