电机转速测量：优化M法+低通滤波方案对比传统PLL

1. 项目背景与核心问题

在电机控制领域，转速测量是闭环控制的基础环节。传统PLL（锁相环）测速方案虽然广泛应用，但在低速工况下存在明显抖动问题。而M法（频率测量法）配合低通滤波的方案常被视为"非主流"选择，业界普遍认为其动态响应较差。这个项目正是要打破这种刻板印象。

我最近在调试一台无刷电机控制器时，实测对比了两种方案。结果发现：在特定场景下，经过优化的M法+低通方案反而比PLL表现更稳定。这促使我深入分析了两种方法的底层原理和适用边界。

2. 技术方案对比分析

2.1 PLL测速原理与痛点

PLL通过相位锁定实现转速跟踪，其核心是一个闭环控制系统：

c复制// 典型PLL实现伪代码
error = target_speed - actual_speed;
output += Kp * error + Ki * integral(error);

优势在于动态响应快，但存在两个固有缺陷：

1. 低速时编码器脉冲间隔拉大，相位误差信号变得稀疏
2. 为保持稳定性，带宽必须限制在采样频率1/10以下

实测数据（1000RPM以下）：

2.2 M法+低通的实现优化

传统M法直接计数脉冲间隔时间，我们做了三点改进：

1. 滑动窗口滤波：

c复制#define WINDOW_SIZE 5
float speed_buf[WINDOW_SIZE];
float get_filtered_speed() {
    float sum = 0;
    for(int i=0; i<WINDOW_SIZE-1; i++){
        speed_buf[i] = speed_buf[i+1];
        sum += speed_buf[i];
    }
    speed_buf[WINDOW_SIZE-1] = new_speed;
    return (sum + new_speed)/WINDOW_SIZE;
}

2. 动态截止频率：

math复制f_c = \begin{cases} 
0.2 \times f_{max} & \text{if } \omega < 30\%\omega_{rated} \\
0.5 \times f_{max} & \text{otherwise}
\end{cases}

3. 脉冲插值补偿：
   在低速段（<5%额定转速），采用定时器捕获边沿+线性预测算法，将有效分辨率提升4-8倍。

3. 实测性能对比

3.1 实验平台配置

• 电机：57BLDC-3000（3000RPM额定）
• 编码器：2500线增量式
• 控制器：STM32F407@168MHz
• 采样周期：100μs

3.2 关键指标对比

实测发现：当转速低于编码器分辨率1/10时，PLL的相位检测误差会指数级放大

4. 实现细节与调参要点

4.1 低通滤波器设计

采用二阶Butterworth滤波器，其传递函数：

math复制H(s) = \frac{\omega_n^2}{s^2 + 2\zeta\omega_ns + \omega_n^2}

参数整定规则：

• 阻尼比ζ=0.707（最佳动态响应）
• 截止频率ω_n=0.2×Nyquist频率

4.2 抗脉冲丢失策略

c复制void speed_measure() {
    static uint32_t last_cnt = 0;
    uint32_t curr_cnt = ENCODER_CNT;
    
    if(curr_cnt == last_cnt) {
        timeout_cnt++;
        if(timeout_cnt > MAX_TIMEOUT) {
            // 启动脉冲丢失补偿算法
            estimated_speed = kalman_predict();
        }
    } else {
        timeout_cnt = 0;
        actual_speed = (curr_cnt - last_cnt) / TIME_BASE;
    }
    last_cnt = curr_cnt;
}

4.3 动态参数调整

根据转速自动切换模式：

mermaid复制graph TD
    A[转速检测] -->|ω < 30%ωN| B[低通模式]
    A -->|ω ≥ 30%ωN| C[原始M法模式]
    B --> D[截止频率=0.2fmax]
    C --> E[截止频率=0.5fmax]

5. 典型问题排查指南

5.1 低速抖动过大

可能原因：

1. 编码器信号噪声（示波器检查A/B相波形）
2. 低通截止频率设置过高
3. 脉冲插值算法参数不匹配

解决方案：

python复制# 自动调参脚本示例
for fc in [0.1, 0.15, 0.2, 0.25]:
    set_cutoff_freq(fc)
    test_jitter = measure_jitter(50RPM)
    if test_jitter < 5%:
        break

5.2 阶跃响应超调

调整步骤：

1. 先降低截止频率直到无超调
2. 逐步提高频率直到出现可接受超调
3. 加入前馈补偿项

6. 方案选型建议

根据应用场景选择：

• 高动态响应优先：选用PLL（如无人机电调）
• 低速稳定性优先：M法+低通（如医疗设备）
• 宽转速范围：混合模式（低速用M法，高速切PLL）

我在工业伺服项目中的实际配置：

c复制typedef struct {
    float pll_kp;
    float pll_ki;
    float lpf_fc;
    uint8_t mode; // 0=M法 1=PLL 2=自动切换
} SpeedConfig;

SpeedConfig cfg = {
    .pll_kp = 0.5f,
    .pll_ki = 0.1f,
    .lpf_fc = 0.2f,
    .mode = 2  // 自动切换
};

经过三个月的现场运行数据统计，改进后的M法方案使低速段位置控制精度提升了42%，这让我重新审视了传统认知的局限性。电机控制没有银弹，理解原理后因地制宜才是王道。