520编码器电机PID控制实战：从参数整定到抗饱和处理

1次阅读

没有评论

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

工业控制中，520 编码器电机常面临两个核心问题：

惯性滞后 ：电机转子质量导致加速 / 减速响应延迟，表现为阶跃响应曲线上升缓慢
超调震荡 ：PID 参数整定不当会引起速度环持续振荡（如 $K_p$ 过大时振幅达±15% 额定转速）

典型现象是给定目标转速 1500rpm 时，实际输出呈现阻尼不足的衰减振荡，稳态误差约±3%，严重影响定位精度。

计算公式：$u(k) = K_p e(k) + K_i \sum_{j=0}^k e(j) + K_d [e(k)-e(k-1)]$
优势：理论精度高
缺陷：每次需计算全量累加和，STM32F407 在 168MHz 下耗时约 12μs

计算公式：$\Delta u(k) = K_p [e(k)-e(k-1)] + K_i e(k) + K_d [e(k)-2e(k-1)+e(k-2)]$
优势：仅需保存前两次误差，计算耗时降至 4μs
特别适合 PWM 周期 1kHz 的应用场景

float IncPID_Calc(float target, float feedback) {static float err[3] = {0};
    err[2] = err[1];
    err[1] = err[0];
    err[0] = target - feedback;

    // 死区处理（±5rpm 不响应）if(fabs(err[0]) < 5.0f/60*encoder_ppr) 
        return 0;

    // 微分先行（仅对反馈量微分）float d_term = K_d * (feedback - 2*err[1] + err[2]);
    return K_p*(err[0]-err[1]) + K_i*err[0] - d_term;
}

物理量转换需注意采样同步问题：

转速计算：
$$ rpm = \frac{\Delta counts \times 60}{encoder_ppr \times control_period} $$
位置计算（32 位计数器防溢出）：
$$ angle = \frac{(int32_t)(count_now – count_last) \times 360}{encoder_ppr} $$

// 在 PID 输出限幅时同步限制积分项
void PID_Clamp(PID_TypeDef* pid, float max_out) {
    float out = pid->p_term + pid->i_term + pid->d_term;

    if(out > max_out) {
        pid->i_term = max_out - pid->p_term - pid->d_term;
        out = max_out;
    }
    else if(out < -max_out) {
        pid->i_term = -max_out - pid->p_term - pid->d_term;
        out = -max_out;
    }

    return out;
}

前馈系数 $K_{ff}$ 通过开环测试获取：
1. 记录电机在 50%PWM 占空比下的稳态转速 $rpm_{50}$
2. 计算：$K_{ff} = \frac{0.5 \times PWM_max}{rpm_{50}}$