工业级1024线正交编码器信号处理：抗干扰方案与FPGA实现

1次阅读

没有评论

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

在伺服电机和 CNC 设备中，1024 线正交编码器是实现高精度位置反馈的关键传感器。但在实际工业环境中，我们常遇到三大干扰源：

长线传输衰减 ：当编码器与控制器距离超过 5 米时，电缆分布电容会导致信号边沿变缓，典型现象是 20MHz 示波器捕获到的上升沿时间超过 200ns
变频器 EMI 干扰 ：PWM 驱动的电机绕组会耦合出高频共模噪声，我们实测某品牌 750W 伺服驱动器在载频 8kHz 时，编码器信号上叠加了高达±1.2V 的噪声
机械振动毛刺 ：某数控车床主轴在 3000rpm 时，由于联轴器微动产生的抖动会引发脉宽 <50ns 的虚假边沿

这些干扰会导致 AB 相信号出现三种典型异常：

边沿抖动（Jitter）：单次触发捕获到多个跳变沿
脉冲丢失（Missing Pulse）：本应出现的边沿未被检测到
相位错误（Phase Error）：AB 相 90°正交关系被破坏

量化到控制性能上，假设电机以 1m/min 速度运动时：

每 100ms 丢失 1 个脉冲 → 0.6mm 位置误差累积
每 100 个脉冲出现 1 次相位错误 → 换向时刻偏差导致转矩波动

方案	延时	资源消耗	适应性
RC 滤波	500ns	低	差
施密特触发器	50ns	中	一般
FPGA 数字滤波	<20ns	可配置	强

动态采样窗口 ：
基础窗口宽度 = 1/(2×最大转速对应的脉冲频率)
动态扩展机制：当连续检测到 3 个有效边沿时，窗口缩小 10%

边沿验证状态机 ：

stateDiagram
  [*] --> IDLE
  IDLE --> EDGE_DETECT: 信号跳变
  EDGE_DETECT --> WINDOW_WAIT: 启动计时
  WINDOW_WAIT --> VALID_EDGE: 窗口内信号稳定
  WINDOW_WAIT --> INVALID_EDGE: 窗口内信号抖动

亚稳态处理 ：
三级寄存器同步链处理跨时钟域信号
格雷码转换用于计数器跨时钟域传递

// 基于 ARM DSP 库的速度预测（STM32H7）void UpdateSpeedEstimate(void) {
    arm_fir_instance_f32 filter;
    float32_t coeffs[3] = {0.2, 0.6, 0.2};
    arm_fir_init_f32(&filter, 3, coeffs, speedHistory);
    arm_fir_f32(&filter, &newPulseInterval, &predictedInterval);
}

module encoder_filter (
    input  wire clk,       // 50MHz 系统时钟
    input  wire A_raw,     // 原始 A 相信号
    output reg  A_clean    // 滤波后 A 相
);
    // 可参数化的窗口计数器
    parameter WINDOW_WIDTH = 8'd10;
    reg [7:0] window_counter;

    always @(posedge clk) begin
        // 边沿检测状态机
        case(state)
            IDLE: if (A_raw ^ last_A) begin
                window_counter <= WINDOW_WIDTH;
                state <= VALIDATION;
            end
            VALIDATION: begin
                window_counter <= window_counter - 1;
                if (window_counter == 0) begin
                    A_clean <= A_raw;
                    state <= IDLE;
                end
            end
        endcase
        last_A <= A_raw;
    end
endmodule

#define HISTORY_SIZE 5
typedef struct {uint32_t timestamp[HISTORY_SIZE];
    float velocity;
} EncoderContext;

void HandleEncoderInterrupt(EncoderContext* ctx) {
    // 更新历史记录
    for(int i=HISTORY_SIZE-1; i>0; i--) {ctx->timestamp[i] = ctx->timestamp[i-1];
    }
    ctx->timestamp[0] = DWT->CYCCNT;

    // 计算瞬时速度
    float dt = (ctx->timestamp[0] - ctx->timestamp[1]) / SystemCoreClock;
    ctx->velocity = 1.0f / (dt * ENCODER_PPR);
}

双绞线节距应满足：
$$ \lambda/10 < p < \lambda/4 $$
其中 λ = 噪声波长，对于 100MHz 噪声 (λ=3m)，推荐节距 7.5cm~30cm

初始设置窗口宽度为 1 /(2×额定最高转速)
逐步提高转速至 120% 额定值
观测示波器捕获的实际信号边沿
调整窗口宽度直至无虚假脉冲

# 伪代码实现连续丢脉冲检测
def pulse_loss_detect(current_count, expected_count):
    error = abs(current_count - expected_count)
    if error > 3:  # 连续 3 个脉冲丢失
        trigger_alarm()
    elif error > 0:
        apply_compensation()