C#编码器实战：通过A相B相精准计算里程的工程实现

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

在 AGV 搬运机器人项目中，我们遇到过因里程计算偏差导致的严重问题：当累计误差超过 5cm 时，搬运台车会在巷道拐角处发生碰撞。更糟糕的是，这种误差会随着运行时间不断累积，最终导致整个导航系统失效。类似的场景也出现在数控机床的刀具定位中，1μm 的脉冲丢失都可能造成零件报废。

一、信号采集方案选型

工业现场常见的编码器信号采集有两种方式：

1. 查询式采样
2. 优点：实现简单，适合低速场景（<1kHz）
3. 缺点：CPU 占用率高（实测 10μs 间隔采样时占用率达 18%）

4. 典型代码：

   while(true)
   {var a = ReadAPhase();
       var b = ReadBPhase();
       Thread.Sleep(10); // 采样间隔控制
   }

5. 中断式采样

6. 优点：零延迟响应，适合高速场景（>10kHz）
7. 缺点：需要硬件支持外部中断引脚
8. 实测数据：
   • 2kHz 信号时 CPU 占用率仅 3%
   • 响应延迟 <1μs

二、核心算法实现

信号消抖模块

采用 System.Threading.Timer 实现硬件级消抖（时间窗口可调）：

record EncoderSignal(bool A, bool B, DateTime Timestamp);

class Debouncer 
{
    private Timer _timer;
    private EncoderSignal _lastStable;

    public Debouncer(TimeSpan interval)
    {
        _timer = new Timer(state => 
        {if(IsStable(_lastStable, currentSignal))
                OnStableSignal?.Invoke(_lastStable);
        }, null, interval, interval);
    }
    // O(1) 时间复杂度
}

四倍频解码算法

状态机实现原理：

stateDiagram
    [*] --> State00
    State00 --> State01: A 上升沿
    State00 --> State10: B 上升沿
    State01 --> State11: B 上升沿 (+1)
    State01 --> State00: A 下降沿 (-1)
    ...（完整状态转移）

里程累计防溢出

采用 unchecked 上下文处理 32 位溢出：

unchecked 
{
    _totalPulses += delta;
    if(_totalPulses < prevPulses) // 溢出检测
        HandleOverflow();}

三、工业现场优化策略

1. 性能基准测试
   | 采样间隔 (μs) | CPU 负载 (%) | 脉冲丢失率 |
   |————–|————|————|
   | 1000 | 1.2 | 0.05% |
   | 100 | 8.7 | 0% |
   | 10 | 32.1 | 0% |

2. 多电机干扰解决方案

3. 使用屏蔽双绞线（STP）
4. 在 IO 模块侧加磁环
5. 代码端施加软件滤波：

   if(IsNoise(pulseWidth)) 
       return Direction.Unknown;

四、常见问题排查

机械振动过滤方案 ：
1. 设置最小脉冲宽度阈值（实测 >50μs 有效）
2. 二次验证法：连续 2 次采样一致才确认有效

EEPROM 存储策略 ：

// 每 1000 个脉冲保存一次
if(_totalPulses % 1000 == 0)
{WriteToEEPROM(BitConverter.GetBytes(_totalPulses));
}

五、扩展思考

现有系统如何兼容 Z 相信号实现归零？可以考虑：
1. 增加中断优先级处理
2. 设计归零补偿算法
3. 建立坐标系映射关系

通过这套方案，我们在 AGV 项目中将里程误差控制在 0.01% 以内，关键是要根据实际场景调整消抖参数和采样频率。下次可以聊聊怎么用卡尔曼滤波进一步优化结果。