Arduino控制编码器电机从入门到实战：精准运动控制指南

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

核心概念：编码器电机基础

编码器电机是在普通电机基础上增加了位置反馈装置的智能执行器。它通过编码器实时记录电机转子的位置和速度信息，形成闭环控制，这是实现精准运动控制的关键。

• 增量式编码器：输出脉冲信号，通过计数脉冲数确定相对位移。常见的有正交编码器（A/ B 相），通过两相信号的相位差判断转向。
• 绝对式编码器：每个位置对应唯一编码值，可直接读取绝对位置但成本较高。
• 为什么需要编码器：开环控制无法克服负载变化、打滑等问题，编码器反馈能实现：
• 精确位置控制（如 3D 打印机）
• 速度稳定（如传送带）
• 扭矩控制（如机械臂）

硬件连接：构建控制系统

以常见的 L298N 电机驱动 +HEDL-5640 编码器为例：

1. 电机驱动连接：
2. IN1/IN2 接 Arduino PWM 引脚（如 D5,D6）控制转向
3. ENA 接 PWM 引脚（如 D9）控制速度

4. 驱动板供电需独立电源（7-12V）

5. 编码器连接：

6. A 相接中断引脚（如 D2）
7. B 相接数字引脚（如 D4）
8. 注意上拉电阻（10kΩ 到 VCC）

接线要点：
– 电机电源与 Arduino 共地
– 长距离传输时使用双绞线抗干扰
– 避免将编码器电源接 5V 以上电压

代码实现：从基础到闭环控制

1. 编码器脉冲读取（中断法）

volatile long encoderPos = 0;

void setup() {pinMode(2, INPUT_PULLUP); // 编码器 A 相
  pinMode(4, INPUT);        // B 相
  attachInterrupt(digitalPinToInterrupt(2), updateEncoder, CHANGE);
}

void updateEncoder() {int b = digitalRead(4);
  encoderPos += (digitalRead(2) == b) ? 1 : -1;
}

2. PID 速度控制实现

#include <PID_v1.h>

// PID 参数
double Kp=1.0, Ki=0.5, Kd=0.1;
double setpoint=100, input, output; // 单位：脉冲 / 秒

PID pid(&input, &output, &setpoint, Kp, Ki, Kd, DIRECT);

void setup() {pid.SetMode(AUTOMATIC);
  pid.SetSampleTime(10); // 10ms 采样周期
}

void loop() {
  static unsigned long lastTime = 0;
  if(millis() - lastTime >= 10) { // 10ms 速度计算
    input = (encoderPos - lastPos) * 100; // 脉冲 / 秒
    lastPos = encoderPos;
    pid.Compute();
    analogWrite(9, output); // 输出 PWM
    lastTime = millis();}
}

性能优化关键点

1. 中断优化：
2. 使用 CHANGE 模式而非 RISING 可提高分辨率

3. 避免在中断服务程序中执行复杂计算

4. 采样频率选择：

5. 速度环建议 10-50ms

6. 位置环可适当延长（100-200ms）

7. 信号处理：

8. 添加硬件滤波（0.1μF 电容并联编码器输入）
9. 软件去抖（示例代码）：

   if((millis() - lastDebounceTime) > 5) {encoderVal = digitalRead(pin);
   }

常见问题解决方案

• 电机抖动不转：
• 检查 ENA 是否使能

• 测量 PWM 输出是否正常

• 编码器计数异常：

• 确认 A / B 相接线正确

• 检查电源电压是否稳定

• PID 调节技巧：

• 先设 Ki=Kd=0，增大 Kp 直到出现小幅振荡
• 增加 Ki 消除静差
• 最后加 Kd 抑制超调

进阶方向

1. 使用 Encoder 库简化读数：

   #include <Encoder.h>
   Encoder myEnc(2, 4);
   long newPos = myEnc.read();

2. 多电机控制：考虑使用 Timer 中断同步采样

3. 拓展到步进电机控制时，需注意：

4. 步进电机通常需要更高频率的脉冲
5. 闭环步进驱动器（如 TMC5160）集成编码器接口

思考与实践

尝试修改 PID 参数，观察不同负载下（如用手阻挡电机）系统的响应速度与稳定性。如何通过自适应算法实现参数自动调整？

实际项目中发现，在 3D 打印机 Z 轴控制中，将 Ki 提高 30% 能有效消除层高误差。这提示我们：不同机械结构需要针对性调参。