C#编码器实战：通过A相B相精准计算里程的技术实现与优化

1次阅读

没有评论

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

在工业自动化项目中，电机编码器的里程计算直接关系到定位精度。但开发者常遇到三大难题：

信号抖动：机械振动或电磁干扰导致 AB 相出现毛刺，引发误计数
方向误判：高速反转时因采样延迟错误识别运动方向
脉冲丢失：传统轮询方式在高速场景下可能漏掉 30% 以上的脉冲

以常见的 1000 线编码器为例，电机 3000rpm 时：

轮询方式（1ms 周期）理论最大采样率 1000Hz
实际需要处理的脉冲频率 = (1000 线×4 倍频×3000rpm)/60 = 200kHz
这意味着轮询会丢失 99.5% 的脉冲！

正交编码器通过相位差 90°的 AB 相提供位置信息：

基础计数：单相上升沿 / 下降沿触发（1 倍频）
2 倍频：利用双相信号边沿
4 倍频：组合边沿 + 电平判断（精度提升 4 倍）

状态转换逻辑如下：

// 4 种状态对应 2 位格雷码
enum EncoderState {S00=0, S01=1, S11=3, S10=2}

// 状态转移表（前状态 | AB 输入 → 新状态 | 方向）// 正向序列：00→01→11→10→00
// 反向序列：00→10→11→01→00

public class EncoderCounter {
    private long _position;
    private readonly int _filterWindow = 5; // 中值滤波窗口

    // 使用 Interlocked 保证多线程安全
    public void Increment(int step) => Interlocked.Add(ref _position, step);
    public long Position => Interlocked.Read(ref _position);
}

public class QuadratureDecoder {
    private EncoderState _lastState;
    private readonly Queue<bool> _aFilterQueue = new(5);
    private readonly Queue<bool> _bFilterQueue = new(5);

    // 中值滤波消除抖动
    private bool GetFilteredSignal(bool current, Queue<bool> queue) {queue.Enqueue(current);
        if(queue.Count > _filterWindow) queue.Dequeue();
        return queue.Count(x => x) > queue.Count / 2;
    }

    public int Update(bool aRaw, bool bRaw) {bool a = GetFilteredSignal(aRaw, _aFilterQueue);
        bool b = GetFilteredSignal(bRaw, _bFilterQueue);

        EncoderState newState = (a, b) switch {(false, false) => EncoderState.S00,
            (false, true)  => EncoderState.S01,
            (true,  true)  => EncoderState.S11,
            (true,  false) => EncoderState.S10
        };

        // 方向判断（状态转移差值为±1 或±3）int delta = (int)_lastState - (int)newState;
        if(delta == 3 || delta == -1) delta = 1;  // 正向
        else if(delta == -3 || delta == 1) delta = -1; // 反向

        _lastState = newState;
        return delta;
    }
}

采样率	300rpm 误差	3000rpm 误差
1kHz	±0.5%	±15%
10kHz	±0.1%	±2%
100kHz	±0.01%	±0.1%

// 使用 MemoryCache 自动持久化
public class PositionStorage {
    private const string CacheKey = "EncoderPosition";
    private readonly MemoryCache _cache = new("EncoderCache");

    public void SavePosition(long pos) {
        _cache.Set(CacheKey, pos, 
            new CacheItemPolicy {Priority = CacheItemPriority.NotRemovable});
    }

    public long LoadPosition() => _cache.Get(CacheKey, 0L);
}