CCS编码器中断读数处理实战：从异常检测到数据恢复

1次阅读

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

去年调试六轴机械臂时，我曾遇到一个诡异现象：每当附近变频器启动时，机械臂末端就会出现 3 -5mm 的随机漂移。经过两周的排查，最终锁定问题根源——编码器信号线受到干扰导致的中断读数丢失。这种看似微小的信号异常，在积分运算后会引发严重的累积误差，最终表现为机械臂定位失准。

编码器信号传输中最头疼的就是信号抖动问题。下图是实测的原始信号波形（此处应有示波器截图）：

解决方案：

RC 滤波电路设计
临界频率计算公式：$f_c = \frac{1}{2\pi RC}$
典型参数选择（针对 100kHz 编码器）：
- R=1kΩ
- C=100pF
- 理论截止频率 159kHz
PCB 布局要点
信号线走内层且包地处理
连接器处放置 TVS 二极管（如 SMBJ5.0CA）
避免与电机电源线平行走线

typedef enum {
    ENCODER_NORMAL,
    ENCODER_FAULT,
    ENCODER_RECOVERING  
} EncoderState;

// 状态转换条件示例
if(LL_GPIO_IsInputPinSet(ENCODER_Z_PORT, ENCODER_Z_PIN)) {if(++fault_counter > FAULT_THRESHOLD) {current_state = ENCODER_FAULT;}
}

关键处理逻辑：

故障判定标准
连续丢失 5 个脉冲（可配置）
Z 相信号超时未触发
恢复策略
故障后首次收到 Z 相信号时切换至 RECOVERING 状态
连续收到 10 个正常脉冲后回归 NORMAL 状态

当检测到中断时，采用二阶运动模型补偿：

$$
\begin{cases}
\theta_{est} = \theta_{last} + \omega_{avg} \cdot \Delta t \
\omega_{avg} = \frac{\omega_{pre1} + \omega_{pre2}}{2}
\end{cases}
$$

卡尔曼滤波实现要点：

// 状态向量定义
typedef struct {
    float position;
    float velocity;
} KalmanState;

// 预测步骤
void kalman_predict(KalmanState* s, float dt) {
    s->position += s->velocity * dt;
    // 此处省略协方差更新
}

void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin) {if(GPIO_Pin == ENCODER_A_PIN) {uint32_t primask = __get_PRIMASK();
        __disable_irq();

        // 边缘检测与计数
        uint8_t a_val = HAL_GPIO_ReadPin(ENCODER_A_GPIO_Port, ENCODER_A_Pin);
        uint8_t b_val = HAL_GPIO_ReadPin(ENCODER_B_GPIO_Port, ENCODER_B_Pin);
        encoder_update(a_val, b_val);

        __set_PRIMASK(primask);
    }
}

#define PULSES_PER_REV (2048)  // 17 位编码器

float get_angular_velocity(uint32_t pulse_count, float delta_t) {
    // 转 / 分钟 -> 弧度 / 秒
    return (pulse_count * 2 * M_PI * 60) / (PULSES_PER_REV * delta_t);
}