3507编码器测速性能优化实战：从原理到高精度实现

1次阅读

没有评论

共计 1758 个字符，预计需要花费 5 分钟才能阅读完成。

在工业自动化控制系统中，编码器的测速精度直接影响设备的运行稳定性和控制质量。今天我们就来聊聊如何通过优化算法和硬件配置，将 3507 编码器的测速误差控制在±0.2% 以内。

工业现场对编码器测速精度的要求通常在 0.5% 以内，但传统的脉冲计数法存在几个明显问题：

低速时脉冲间隔大，采样周期长导致分辨率不足
高速时容易丢失脉冲，特别是在信号抖动的情况下
干扰信号会导致误触发，产生计数误差

常见的测速方法有 M 法（测频法）和 T 法（测周期法）：

M 法 ：固定时间内计数脉冲数，适合高速场合
T 法 ：测量两个脉冲间的时间，适合低速场合

经过对比测试，我们最终选择了 M/ T 混合法 ，它结合了两者的优点：

低速时自动切换为 T 法模式
高速时采用 M 法模式
在中间速度段同时使用两种方法计算

使用 TIM 定时器的编码器接口模式可以硬件自动识别 A / B 相方向，大大简化了软件设计。关键配置代码如下：

// TIM3 编码器模式初始化
void Encoder_Configuration(void)
{
    TIM_EncoderInterfaceConfig(TIM3, TIM_EncoderMode_TI12, 
                              TIM_ICPolarity_Rising, TIM_ICPolarity_Rising);
    TIM_SetAutoreload(TIM3, 0xFFFF);  // 16 位最大计数值
    TIM_Cmd(TIM3, ENABLE);            // 使能定时器
}

采用二阶巴特沃斯低通滤波器，使用 Q15 定点数运算优化性能：

#define Q15_SHIFT 15

int32_t Butterworth_Filter(int32_t input)
{static int32_t x[3] = {0}, y[3] = {0};

    // 差分方程: y[n] = b0*x[n] + b1*x[n-1] + b2*x[n-2] - a1*y[n-1] - a2*y[n-2]
    x[2] = x[1]; x[1] = x[0]; x[0] = input;

    // 系数已转换为 Q15 格式（fc=100Hz, fs=1kHz）y[2] = y[1]; y[1] = y[0];
    y[0] = (( 1248 * x[0] ) >> Q15_SHIFT ) 
         + (( 2496 * x[1] ) >> Q15_SHIFT ) 
         + (( 1248 * x[2] ) >> Q15_SHIFT ) 
         - (( -13729 * y[1] ) >> Q15_SHIFT ) 
         - (( 5395 * y[2] ) >> Q15_SHIFT );

    return y[0];
}

测试数据如下表所示（单位：RPM）：

设定转速	实测转速	误差率
500	499.1	0.18%
1000	998.3	0.17%
2000	1996.4	0.18%

示波器观察显示，原始信号存在明显的毛刺干扰（约±5% 幅值波动），经过滤波后信号平滑度显著改善。

在读取计数器值时必须关闭全局中断，防止被其他中断打断：

__disable_irq();
count = TIM_GetCounter(TIM3);
__enable_irq();

信号线采用双绞线布线
在编码器端和控制器端加装磁环
电源线增加 π 型滤波电路

实现转速变化率限制，防止突变：

#define MAX_DELTA_RPM 100  // 最大允许转速变化量 (RPM/sample)

int32_t Speed_Limiter(int32_t new_speed)
{
    static int32_t old_speed = 0;
    int32_t delta = new_speed - old_speed;

    if(delta > MAX_DELTA_RPM) 
        new_speed = old_speed + MAX_DELTA_RPM;
    else if(delta < -MAX_DELTA_RPM)
        new_speed = old_speed - MAX_DELTA_RPM;

    old_speed = new_speed;
    return new_speed;
}

通过这套优化方案，我们在实际产线上实现了稳定的高精度测速。关键点在于：