Arduino控制编码器电机实战：从PID调参到运动控制优化

1次阅读

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

编码器电机在机器人、CNC 机床等场景中扮演着关键角色，能够实现精确的位置和速度控制。然而，开发者在实际应用中常遇到位置漂移、响应震荡等问题。这些问题的根源往往在于编码器信号处理不当或 PID 参数整定不佳。

增量式编码器通过 A、B 两相输出正交信号，每转产生固定数量的脉冲。通过四倍频计数，可以显著提高分辨率，从而实现更精确的控制。

Arduino 与编码器电机连接示意图：
编码器 A 相连接至 Arduino 中断引脚（如 D2）
编码器 B 相连接至另一中断引脚（如 D3）
电机驱动模块 PWM 输入连接至 Arduino PWM 引脚（如 D9）
确保电机供电与 Arduino 共地

使用 Encoder 库实现四倍频计数

#include <Encoder.h>
Encoder myEncoder(2, 3); // 使用 D2 和 D3 引脚

带死区补偿的 PID 控制代码

// PID 参数
float Kp = 1.0, Ki = 0.1, Kd = 0.01;
float error, lastError, integral, derivative;
float output, setpoint, actual;
float deadband = 5.0; // 死区范围（单位：编码器计数）void computePID() {
  error = setpoint - actual;
  if (abs(error) > deadband) {
    integral += error;
    // 抗积分饱和处理
    integral = constrain(integral, -100, 100);
  }
  derivative = error - lastError;
  output = Kp * error + Ki * integral + Kd * derivative;
  lastError = error;
}

串口实时绘制转速曲线

void setup() {Serial.begin(115200);
}

void loop() {long newPosition = myEncoder.read();
  // 计算转速（单位：RPM）float rpm = (newPosition - lastPosition) * 60.0 / (PPR * 4 * sampleTime);
  Serial.println(rpm);
  lastPosition = newPosition;
  delay(sampleTime);
}