当前位置：首页 > news >正文

ESP32与TB6612FNG实战：串口指令解析与直流电机闭环调速系统

news 2026/4/16 20:50:49

1. ESP32与TB6612FNG电机控制入门

第一次接触ESP32和TB6612FNG电机驱动模块时，我被这个组合的灵活性惊艳到了。ESP32作为一款性价比极高的WiFi/蓝牙双模芯片，搭配TB6612FNG这个双路H桥驱动，简直就是DIY智能小车和机械臂的黄金搭档。在实际项目中，我经常用这套方案来实现精确的电机控制，今天就把我的实战经验分享给大家。

TB6612FNG这个驱动芯片真的很适合初学者。它内置了MOSFET驱动电路，最大能输出1.2A的连续电流（峰值3.2A），驱动12V以下的直流电机完全没问题。相比L298N这类老款驱动，它的发热量小得多，不用额外加散热片。记得我第一次用的时候，连续工作了2小时，摸上去只是温温的。

硬件连接其实特别简单，ESP32的GPIO引脚直接对接TB6612FNG的控制端就行。这里有个小技巧：STM32的PWM频率默认是1kHz，但ESP32可以轻松调到50kHz以上。高频PWM能让电机运行更平稳，噪音也会小很多。我在智能小车项目里实测过，同样的电机，5kHz PWM下的嗡嗡声明显比1kHz时小。

2. 串口指令系统设计实战

要让电机听话，首先得设计一套好用的指令系统。我建议采用ASCII字符协议，比二进制协议更易调试。比如用"S100,200"表示设置电机A转速100、电机B转速200，用"D1,0"表示电机A正转、电机B停止。这种格式在串口助手里调试特别方便。

在代码实现上，我推荐使用状态机方式解析串口数据。下面是我优化过的代码框架：

String inputBuffer = ""; bool commandReady = false; void serialEvent() { while (Serial.available()) { char inChar = (char)Serial.read(); if (inChar == '\n') { commandReady = true; break; } inputBuffer += inChar; } } void processCommand() { if (!commandReady) return; char cmdType = inputBuffer[0]; String params = inputBuffer.substring(1); switch(cmdType) { case 'S': // 设置转速 int commaPos = params.indexOf(','); int speedA = params.substring(0, commaPos).toInt(); int speedB = params.substring(commaPos+1).toInt(); setMotorSpeed(MOTOR_A, speedA); setMotorSpeed(MOTOR_B, speedB); break; // 其他指令处理... } inputBuffer = ""; commandReady = false; }

实际使用中发现，串口通信最怕数据粘包。我的解决方案是每条指令加CRC校验，同时在指令头尾添加特殊字符作为帧界定符。比如"$S100,200#CRC\r\n"这样的格式，可靠性大幅提升。

3. PWM调速的进阶技巧

PWM调速看似简单，但要调出好效果需要点技巧。首先是频率选择，我测试过不同频率下的电机表现：

1kHz：电机有明显啸叫，但响应最快
5kHz：平衡点，噪音适中，响应够快
20kHz：人耳听不到噪音，但响应稍慢

对于ESP32，推荐这样初始化PWM：

const int PWM_FREQ = 5000; // 5kHz const int PWM_RESOLUTION = 8; // 8位分辨率(0-255) void setupPWM() { ledcSetup(MOTOR_A_CHANNEL, PWM_FREQ, PWM_RESOLUTION); ledcAttachPin(MOTOR_A_PIN, MOTOR_A_CHANNEL); // 同理初始化电机B... }

占空比控制有个坑要注意：电机启动需要更大的初始力矩。我的经验是前10%的PWM值基本无效，建议做非线性映射：

int mapPWM(int speed) { if(speed == 0) return 0; // 将0-100%映射为25-255 return constrain(map(speed, 0, 100, 25, 255), 0, 255); }

在机械臂项目中，我还加入了PWM渐变功能，让电机转速平滑过渡。实现方法是用定时器逐步调整PWM值，每次增减不超过5%，这样机械臂运动看起来就很流畅。

4. 构建闭环控制系统

开环控制简单但精度不够，特别是负载变化时转速会波动。我的解决方案是加装编码器实现闭环控制。我用的是600PPR的增量式编码器，通过ESP32的PCNT外设直接计数，不占用CPU资源。

闭环控制的核心是PID算法。这里分享一个经过实测的简化版PID实现：

class SimplePID { public: SimplePID(float kp, float ki, float kd) : Kp(kp), Ki(ki), Kd(kd) {} int compute(int setpoint, int input) { unsigned long now = millis(); float dt = (now - lastTime) / 1000.0; if(dt <= 0) dt = 0.01; int error = setpoint - input; integral += error * dt; float derivative = (error - lastError) / dt; lastError = error; lastTime = now; return Kp*error + Ki*integral + Kd*derivative; } private: float Kp, Ki, Kd; float integral = 0; int lastError = 0; unsigned long lastTime = 0; };

调参是个耐心活，我的经验值是先用Ziegler-Nichols法初步确定参数，再微调：

先设Ki=Kd=0，增大Kp直到系统开始振荡
取振荡周期Tu和临界增益Ku
按规则计算PID参数：Kp=0.6Ku, Ki=2Kp/Tu, Kd=KpTu/8

在智能小车项目里，闭环控制让车速稳定性提升了70%。即使爬坡时，也能保持设定速度不变。

5. 系统优化与故障排查

系统整合后可能会遇到各种奇怪问题。我总结了几种常见情况：

电机抖动不转：大概率是电源问题。TB6612FNG需要两个电源 - VM(电机电源)和VCC(逻辑电源)。一定要确保：

VM电压足够驱动电机（我常用12V）
VCC在2.7-5.5V之间（接ESP32的3.3V）
两个电源的GND必须共地

PWM控制异常：检查三点：

ESP32的PWM通道是否配置正确
TB6612FNG的STBY引脚是否接高电平
电机控制引脚电平组合是否正确（正转01/反转10）

串口指令丢失：建议在代码中加入超时机制：

unsigned long lastCmdTime = 0; void loop() { if(millis() - lastCmdTime > 1000) { // 1秒没收到新指令，自动停止电机 setMotorSpeed(MOTOR_A, 0); setMotorSpeed(MOTOR_B, 0); } }

对于抗干扰，我的经验是：

电机电源线要加磁环
在TB6612FNG的VM引脚就近并联100uF电解电容+0.1uF陶瓷电容
编码器信号线用双绞线

6. 项目实战：智能小车速度控制

以智能小车为例，分享我的完整实现方案。硬件配置：

ESP32做主控
两个TB6612FNG分别驱动4个电机（并联使用）
车轮装600线编码器
MPU6050做姿态补偿

速度控制逻辑分三层：

上层：通过串口/WiFi接收速度指令
中层：PID控制器计算PWM修正值
底层：PWM驱动电机

关键代码如下：

void controlTask(void *pvParams) { SimplePID pid(0.8, 0.5, 0.1); int targetSpeed = 0; while(1) { // 获取编码器计数 int actualSpeed = getEncoderSpeed(); // PID计算 int pwm = pid.compute(targetSpeed, actualSpeed); // 驱动电机 setMotorPWM(pwm); vTaskDelay(10 / portTICK_PERIOD_MS); } } void setup() { // 初始化硬件... // 创建独立任务运行控制算法 xTaskCreate(controlTask, "ctrl", 4096, NULL, 1, NULL); }

这个方案在1:10的爬坡测试中，速度误差能控制在±3%以内。如果想进一步提升性能，可以加入加速度前馈补偿，这个我们在机械臂项目中效果很明显。

查看全文

http://www.jsqmd.com/news/651908/