你的第一个双轮差速小车底盘：Arduino Mega2560核心，TB6612驱动MG513电机全攻略（附完整代码库）

从零搭建双轮差速机器人：Arduino Mega2560与TB6612驱动MG513电机实战指南

1. 项目概述与核心组件解析

双轮差速底盘是移动机器人开发中最基础也最经典的机械结构之一。这种设计通过独立控制两个驱动轮的速度差来实现转向，结构简单却功能强大，非常适合作为机器人学习的入门项目。本文将带领你使用Arduino Mega2560作为主控板，配合TB6612电机驱动模块和MG513直流减速电机，构建一个完整的双轮差速底盘系统。

核心组件选型考量：

• Arduino Mega2560：拥有54个数字I/O引脚（其中15个支持PWM）和16个模拟输入，充足的硬件资源为多传感器扩展预留空间
• TB6612FNG驱动模块：相比传统L298N，效率更高（最高达95%），支持1.2A持续电流/3.2A峰值电流输出
• MG513直流减速电机：内置霍尔编码器（13线/圈），配合30:1减速箱，提供精确的转速反馈

提示：选购电机时需确认编码器类型（霍尔/光电）及线数，这直接影响后续测速算法的实现

2. 硬件系统搭建与电路设计

2.1 电源系统架构

双电源方案是保证系统稳定运行的关键：

1. 电机驱动电源：12V/2A锂电池组直接供给TB6612的VM引脚
2. 控制电路电源：可通过TB6612的5V稳压输出或独立USB供电

// 电源电压监测代码示例（接在模拟引脚A0） void readBatteryVoltage() { float voltage = analogRead(A0) * (5.0 / 1023.0) * 3; // 假设使用1:3分压电路 Serial.print("Battery: "); Serial.print(voltage); Serial.println("V"); }

2.2 接线规范与引脚分配

关键接线对照表：

注意：编码器线建议使用屏蔽线，并远离电机电源线以减少干扰

3. 电机控制核心算法实现

3.1 基础运动函数库开发

建立可复用的电机控制类能大幅提升开发效率：

class DifferentialDrive { private: // 电机控制引脚 int pinAIN1, pinAIN2, pinPWMA; int pinBIN1, pinBIN2, pinPWMB; // 编码器相关变量 volatile long encoderCountA = 0; volatile long encoderCountB = 0; public: DifferentialDrive(int a1, int a2, int pwa, int b1, int b2, int pwb) { // 构造函数初始化引脚 pinAIN1 = a1; pinAIN2 = a2; pinPWMA = pwa; pinBIN1 = b1; pinBIN2 = b2; pinPWMB = pwb; // 设置引脚模式 pinMode(pinAIN1, OUTPUT); pinMode(pinAIN2, OUTPUT); pinMode(pinBIN1, OUTPUT); pinMode(pinBIN2, OUTPUT); pinMode(pinPWMA, OUTPUT); pinMode(pinPWMB, OUTPUT); } void setMotorSpeed(int motor, int speed) { // 限幅处理 speed = constrain(speed, -255, 255); if(motor == 0) { // 左电机 digitalWrite(pinAIN1, speed > 0 ? HIGH : LOW); digitalWrite(pinAIN2, speed > 0 ? LOW : HIGH); analogWrite(pinPWMA, abs(speed)); } else { // 右电机 digitalWrite(pinBIN1, speed > 0 ? HIGH : LOW); digitalWrite(pinBIN2, speed > 0 ? LOW : HIGH); analogWrite(pinPWMB, abs(speed)); } } // 编码器中断服务函数 static void encoderISRA() { /* 实现四倍频计数 */ } static void encoderISRB() { /* 实现四倍频计数 */ } };

3.2 编码器信号处理与转速计算

采用四倍频技术可显著提高测速精度：

// 在类中添加以下方法 void setupEncoders(int pinA1, int pinB1, int pinA2, int pinB2) { // 配置编码器引脚为上拉输入 pinMode(pinA1, INPUT_PULLUP); pinMode(pinB1, INPUT_PULLUP); pinMode(pinA2, INPUT_PULLUP); pinMode(pinB2, INPUT_PULLUP); // 配置中断（Mega2560所有引脚都支持中断） attachInterrupt(digitalPinToInterrupt(pinA1), encoderISRA, CHANGE); attachInterrupt(digitalPinToInterrupt(pinB1), encoderISRA, CHANGE); attachInterrupt(digitalPinToInterrupt(pinA2), encoderISRB, CHANGE); attachInterrupt(digitalPinToInterrupt(pinB2), encoderISRB, CHANGE); } float getRPM(int motor) { // 每转脉冲数 = 编码器线数 × 减速比 × 4（四倍频） const int PULSE_PER_REV = 13 * 30 * 4; static unsigned long lastTime = 0; static long lastCountA = 0, lastCountB = 0; unsigned long dt = millis() - lastTime; if(dt < 100) return 0.0; // 采样周期100ms float rpm; if(motor == 0) { rpm = (encoderCountA - lastCountA) * 60000.0 / (PULSE_PER_REV * dt); lastCountA = encoderCountA; } else { rpm = (encoderCountB - lastCountB) * 60000.0 / (PULSE_PER_REV * dt); lastCountB = encoderCountB; } lastTime = millis(); return rpm; }

4. 运动控制进阶技巧

4.1 差速转向算法实现

通过速度差实现转向是双轮底盘的核心特性：

void move(float linear, float angular) { // 线速度单位：m/s，角速度单位：rad/s const float WHEEL_RADIUS = 0.0325; // 轮子半径(m) const float WHEEL_SEPARATION = 0.15; // 轮距(m) // 计算左右轮目标转速(rpm) float left_rpm = (linear - angular * WHEEL_SEPARATION / 2) * 60 / (2 * M_PI * WHEEL_RADIUS); float right_rpm = (linear + angular * WHEEL_SEPARATION / 2) * 60 / (2 * M_PI * WHEEL_RADIUS); // 转换为PWM值（需根据实际测试校准） int left_pwm = constrain(left_rpm * 2, -255, 255); int right_pwm = constrain(right_rpm * 2, -255, 255); setMotorSpeed(0, left_pwm); setMotorSpeed(1, right_pwm); }

4.2 运动控制状态机设计

引入状态机管理可使运动控制更加可靠：

enum RobotState { STOPPED, MOVING_FORWARD, MOVING_BACKWARD, TURNING_LEFT, TURNING_RIGHT }; RobotState currentState = STOPPED; void updateState(float targetLinear, float targetAngular) { if(abs(targetLinear) < 0.01 && abs(targetAngular) < 0.01) { currentState = STOPPED; } else if(targetLinear > 0.1 && abs(targetAngular) < 0.1) { currentState = MOVING_FORWARD; } else if(targetLinear < -0.1 && abs(targetAngular) < 0.1) { currentState = MOVING_BACKWARD; } else if(targetAngular > 0.5) { currentState = TURNING_LEFT; } else if(targetAngular < -0.5) { currentState = TURNING_RIGHT; } // 根据状态执行相应动作 switch(currentState) { case STOPPED: setMotorSpeed(0, 0); setMotorSpeed(1, 0); break; // 其他状态处理... } }

5. 系统集成与调试技巧

5.1 串口调试工具开发

构建可视化调试界面能极大提升开发效率：

void serialDebugOutput() { static unsigned long lastDebugTime = 0; if(millis() - lastDebugTime < 200) return; // 200ms间隔 Serial.print("Left RPM:"); Serial.print(getRPM(0)); Serial.print(" Right RPM:"); Serial.print(getRPM(1)); Serial.print(" Battery:"); Serial.print(readBatteryVoltage()); Serial.println("V"); lastDebugTime = millis(); }

5.2 常见问题排查指南

电机不转检查清单：

1. 确认STBY引脚已置高
2. 检查PWM信号是否正常（可用示波器或LED测试）
3. 测量电机端子间电压是否达到预期
4. 确认电源供电能力足够（启动电流可能达稳态3倍）

编码器读数异常处理：

• 现象：转��显示为0或跳动剧烈
• 解决方案：
  • 检查编码器接线是否松动
  • 确认中断服务函数注册正确
  • 尝试添加10kΩ上拉电阻
  • 在中断服务函数中添加防抖延迟

// 改进的编码器中断服务函数（添加防抖） void encoderISR() { static unsigned long lastInterruptTime = 0; unsigned long interruptTime = millis(); if(interruptTime - lastInterruptTime > 5) { // 5ms防抖 // 正常处理逻辑 } lastInterruptTime = interruptTime; }

6. 扩展功能与升级路径

6.1 上位机通信协议设计

实现与PC或手机的数据交互：

// 简易通信协议示例 void handleSerialCommand() { if(Serial.available() > 0) { char cmd = Serial.read(); switch(cmd) { case 'F': move(0.2, 0); break; // 前进 case 'B': move(-0.2, 0); break; // 后退 case 'L': move(0, 0.5); break; // 左转 case 'R': move(0, -0.5); break; // 右转 case 'S': move(0, 0); break; // 停止 } } }

6.2 进阶开发方向

1. PID速度闭环控制：

   // 简易PID实现示例 class PIDController { public: PIDController(float kp, float ki, float kd) { Kp = kp; Ki = ki; Kd = kd; } float compute(float setpoint, float input) { float error = setpoint - input; integral += error * dt; derivative = (error - lastError) / dt; output = Kp*error + Ki*integral + Kd*derivative; lastError = error; return output; } };

2. SLAM建图与导航：可接入RPLIDAR和ROS系统

3. 机器视觉集成：搭配OpenMV或Raspberry Pi实现视觉跟随

4. 无线遥控方案：蓝牙/WiFi/2.4G多种选择

在完成基础底盘搭建后，尝试为机器人添加超声波避障模块时，发现电机干扰导致测距数据异常。通过为传感器电源添加LC滤波电路，并将测距采样与电机PWM刷新错开时序，最终获得了稳定的环境感知数据。这种实际问题解决经验往往比理论更珍贵。