别再让电机乱转了！用Arduino Mega2560 + TB6612驱动MG513，手把手教你实现精准PWM调速与正反转控制

Arduino Mega2560 + TB6612驱动MG513电机：从失控到精准控制的实战指南

当你第一次尝试用Arduino控制直流电机时，是否遇到过这样的场景：电机要么纹丝不动，要么突然全速运转，完全不听使唤？这种"失控"体验让许多初学者感到挫败。本文将带你深入理解TB6612驱动模块与MG513电机的配合原理，通过系统化的方法实现精准的PWM调速和可靠的正反转控制。

1. 理解TB6612驱动模块的核心机制

TB6612是一款双通道直流电机驱动芯片，它能同时驱动两个直流电机，最大输出电流可达1.2A（连续）和3.2A（峰值）。与常见的L298N相比，TB6612具有更高的效率和更低的发热量，特别适合电池供电的移动机器人项目。

1.1 TB6612的真值表与常见误区

许多初学者在使用TB6612时最容易忽略的是STBY（Standby）引脚的作用。这个引脚必须设置为高电平（通常接5V），否则无论其他引脚如何配置，电机都不会工作。这是TB6612的一个安全特性，但却成为了新手最常见的"坑"。

TB6612控制逻辑的真值表如下：

X表示任意值

1.2 电源系统的合理配置

TB6612需要三个电源输入：

1. VM：电机电源（7.2V-12V），直接连接外部电源正极
2. VCC：逻辑电源（2.7V-5.5V），可接Arduino的5V输出
3. GND：共地连接，必须将Arduino、TB6612和外部电源的地线连接在一起

注意：如果使用TB6612的稳压版本（带LDO），可以通过5V引脚为Arduino供电，但要注意总电流不要超过稳压芯片的承载能力。

2. Arduino Mega2560的引脚配置策略

Arduino Mega2560有15个PWM引脚（标有~符号），比UNO多出不少，这为多电机控制提供了便利。但在实际项目中，我们需要合理规划引脚用途。

2.1 PWM引脚与数字引脚的区别

PWM引脚可以输出模拟信号（通过PWM模拟），而普通数字引脚只能输出HIGH或LOW。对于TB6612：

• PWMA/PWMB：必须连接PWM引脚，用于调速
• AIN1/AIN2/BIN1/BIN2：可连接普通数字引脚，用于控制方向
• STBY：可连接普通数字引脚

推荐引脚分配方案：

2.2 引脚初始化最佳实践

在setup()函数中，正确的引脚初始化顺序应该是：

1. 设置STBY引脚为输出模式并置高
2. 设置方向控制引脚为输出模式
3. 设置PWM引脚为输出模式
4. 初始化所有输出状态

void setup() { // 1. 使能TB6612 pinMode(STBY, OUTPUT); digitalWrite(STBY, HIGH); // 2. 初始化方向控制引脚 pinMode(AIN1, OUTPUT); pinMode(AIN2, OUTPUT); pinMode(BIN1, OUTPUT); pinMode(BIN2, OUTPUT); // 3. 初始化PWM引脚 pinMode(PWMA, OUTPUT); pinMode(PWMB, OUTPUT); // 4. 设置初始状态（停止） digitalWrite(AIN1, LOW); digitalWrite(AIN2, LOW); digitalWrite(BIN1, LOW); digitalWrite(BIN2, LOW); analogWrite(PWMA, 0); analogWrite(PWMB, 0); }

3. 实现可复用的电机控制函数

为了提升代码的可维护性和复用性，我们应该将电机控制逻辑封装成独立的函数。这不仅使主程序更简洁，也方便在不同项目间迁移代码。

3.1 SetPWM函数的进阶实现

以下是一个增强版的SetPWM函数，它增加了安全检查和更灵活的控制方式：

/** * 设置电机速度和方向 * @param motor 电机编号（1=电机A，2=电机B） * @param speed 速度值（-255~255），负值表示反转 * @param brake 是否制动（可选，默认false） */ void SetPWM(int motor, int speed, bool brake = false) { // 限制速度范围 speed = constrain(speed, -255, 255); if(motor == 1) { // 电机A if(brake) { digitalWrite(AIN1, HIGH); digitalWrite(AIN2, HIGH); } else if(speed > 0) { // 正转 digitalWrite(AIN1, HIGH); digitalWrite(AIN2, LOW); analogWrite(PWMA, speed); } else if(speed < 0) { // 反转 digitalWrite(AIN1, LOW); digitalWrite(AIN2, HIGH); analogWrite(PWMA, -speed); } else { // 停止 digitalWrite(AIN1, LOW); digitalWrite(AIN2, LOW); analogWrite(PWMA, 0); } } else if(motor == 2) { // 电机B if(brake) { digitalWrite(BIN1, HIGH); digitalWrite(BIN2, HIGH); } else if(speed > 0) { // 正转 digitalWrite(BIN1, HIGH); digitalWrite(BIN2, LOW); analogWrite(PWMB, speed); } else if(speed < 0) { // 反转 digitalWrite(BIN1, LOW); digitalWrite(BIN2, HIGH); analogWrite(PWMB, -speed); } else { // 停止 digitalWrite(BIN1, LOW); digitalWrite(BIN2, LOW); analogWrite(PWMB, 0); } } }

3.2 通过串口实时调试PWM值

为了精确控制电机速度，我们可以通过串口监视器实时调整PWM值：

void loop() { if(Serial.available() > 0) { char cmd = Serial.read(); int value = Serial.parseInt(); switch(cmd) { case 'A': // 设置电机A速度 SetPWM(1, value); Serial.print("电机A设置为："); Serial.println(value); break; case 'B': // 设置电机B速度 SetPWM(2, value); Serial.print("电机B设置为："); Serial.println(value); break; case 'S': // 停止所有电机 SetPWM(1, 0); SetPWM(2, 0); Serial.println("所有电机已停止"); break; } } }

使用时，在串口监视器中输入：

• "A 150" → 设置电机A速度为150
• "B -200" → 设置电机B反转，速度为200
• "S" → 停止所有电机

4. MG513电机特性与性能优化

MG513是一款带编码器的直流减速电机，额定电压为12V，空载转速约为100RPM（取决于减速比）。它的编码器输出为AB相正交信号，可用于精确的速度和位置控制。

4.1 电机参数与PWM响应曲线

通过实验测试，我们发现MG513电机对PWM的响应并非完全线性。在低速区域（PWM<50），由于静摩擦和电机启动电流的影响，电机可能无法启动或运转不平稳。以下是实测的PWM-转速关系：

基于这些数据，我们可以实现一个速度映射函数，使电机响应更符合预期：

int MapSpeed(int desiredRPM) { // MG513最大转速约为100RPM desiredRPM = constrain(desiredRPM, 0, 100); // 非线性映射表 if(desiredRPM == 0) return 0; if(desiredRPM <= 15) return 50; if(desiredRPM <= 35) return map(desiredRPM, 16, 35, 55, 80); if(desiredRPM <= 60) return map(desiredRPM, 36, 60, 85, 120); if(desiredRPM <= 85) return map(desiredRPM, 61, 85, 125, 180); return map(desiredRPM, 86, 100, 185, 255); }

4.2 编码器信号处理与速度计算

MG513的霍尔编码器通常提供13PPR（每转脉冲数），结合减速比30:1，输出轴每转会产生390个脉冲（13×30）。如果使用四倍频计数技术，这个值将变为1560（390×4）。

以下是计算电机转速的代码实现：

// 编码器参数 const int PPR = 13; // 编码器每转脉冲数 const int GEAR_RATIO = 30; // 减速比 const int PULSES_PER_REV = PPR * GEAR_RATIO * 4; // 四倍频后的每转脉冲数 volatile long encoderCount = 0; unsigned long lastTime = 0; // 编码器中断服务程序 void EncoderISR() { // 根据A相和B相的状态判断方向 static uint8_t oldAB = 0; oldAB = (oldAB << 2) | (digitalRead(ENCODER_A) << 1) | digitalRead(ENCODER_B); oldAB &= 0x0F; // 状态变化时增加或减少计数 if(oldAB == 0b0001 || oldAB == 0b0111 || oldAB == 0b1110 || oldAB == 0b1000) { encoderCount++; } else if(oldAB == 0b0010 || oldAB == 0b1011 || oldAB == 0b1101 || oldAB == 0b0100) { encoderCount--; } } // 计算RPM float CalculateRPM() { unsigned long currentTime = millis(); unsigned long elapsedTime = currentTime - lastTime; if(elapsedTime >= 100) { // 每100ms计算一次 noInterrupts(); long count = encoderCount; encoderCount = 0; interrupts(); lastTime = currentTime; float rpm = (count * 60000.0) / (elapsedTime * PULSES_PER_REV); return rpm; } return -1; // 未到计算时间 }

5. 常见问题排查与解决方案

即使按照正确步骤连接和编程，仍然可能遇到各种问题。以下是几个典型问题及其解决方法：

5.1 电机完全不转

检查清单：

1. STBY引脚：确认已设置为HIGH
2. 电源连接：
   • 测量VM引脚电压是否达到电机额定电压（12V）
   • 检查VCC是否有5V
   • 确认所有地线（GND）已正确连接
3. 引脚配置：
   • 确认PWM引脚已正确初始化为OUTPUT
   • 检查AIN1/AIN2或BIN1/BIN2的组合是否符合真值表
4. 代码问题：
   • 确保没有在setup()中遗漏引脚初始化
   • 检查loop()中是否实际调用了控制函数

5.2 电机转动方向与预期相反

解决方法：

1. 交换AIN1和AIN2的连接
2. 或者在代码中交换HIGH/LOW逻辑：

   // 原正转逻辑 digitalWrite(AIN1, HIGH); digitalWrite(AIN2, LOW); // 改为 digitalWrite(AIN1, LOW); digitalWrite(AIN2, HIGH);

5.3 PWM调速不线性或电机抖动

可能原因及解决方案：

1. PWM频率问题：
   • Arduino默认PWM频率约为490Hz
   • 对于某些电机，可以尝试更高频率（如使用Timer1设置）

   // 将Pin9和Pin10的PWM频率提高到约31kHz TCCR1B = TCCR1B & 0b11111000 | 0x01;

2. 死区补偿：
   • 在PWM值低于某个阈值时强制为0

   if(abs(speed) < MIN_PWM) { speed = 0; }

3. 电源功率不足：
   • 检查电源是否能提供足够电流
   • 添加大容量电容（如1000μF）到电机电源端

5.4 编码器计数不准确

调试步骤：

1. 使用示波器或逻辑分析仪检查编码器信号质量
2. 确保中断引脚连接正确（Mega2560的中断引脚为2,3,18,19,20,21）
3. 在中断服务程序中添加去抖动逻辑：

   void EncoderISR() { static unsigned long lastInterruptTime = 0; unsigned long interruptTime = millis(); // 去抖动 - 忽略10ms内的连续触发 if(interruptTime - lastInterruptTime > 10) { // 正常处理逻辑 } lastInterruptTime = interruptTime; }

6. 进阶应用：构建闭环速度控制系统

有了编码器反馈，我们可以实现简单的闭环速度控制。以下是一个基于比例控制(P控制)的实现示例：

// PID参数 float Kp = 0.8; // 比例系数 float targetRPM = 0; // 目标转速 int currentPWM = 0; // 当前PWM输出 void loop() { // 获取当前转速 float currentRPM = CalculateRPM(); if(currentRPM >= 0) { // 有新的转速数据 // 计算误差 float error = targetRPM - currentRPM; // P控制 int adjustment = Kp * error; currentPWM += adjustment; // 限制PWM范围 currentPWM = constrain(currentPWM, 0, 255); // 应用新的PWM值 SetPWM(1, currentPWM); // 串口输出调试信息 Serial.print("Target:"); Serial.print(targetRPM); Serial.print(" Actual:"); Serial.print(currentRPM); Serial.print(" PWM:"); Serial.println(currentPWM); } // 通过串口设置目标转速 if(Serial.available() > 0) { targetRPM = Serial.parseInt(); Serial.print("New target RPM:"); Serial.println(targetRPM); } delay(10); }

这个简单的控制系统已经能够显著改善电机速度的稳定性，特别是在负载变化的情况下。对于更精确的控制，可以考虑实现完整的PID控制器。