ESP32机器人控制：从硬件搭建到运动算法实现

洛裳

1. 项目概述

作为一名嵌入式开发工程师，我最近参与了一个机器人设计与应用的综合实训项目。这个项目以ESP32为核心控制器，涵盖了从硬件搭建到软件开发的完整流程。今天我想重点分享第三天的技术内容，这部分主要涉及ESP32的高级开发技巧和机器人运动控制实现。

ESP32作为一款性价比极高的Wi-Fi+蓝牙双模芯片，在机器人控制领域有着广泛应用。它集成了丰富的外设接口和强大的计算能力，非常适合作为中小型机器人的主控芯片。在本次实训中，我们使用ESP32实现了机器人的基本运动控制、传感器数据采集和无线通信功能。

2. 硬件设计与搭建

2.1 ESP32核心板选型

市面上ESP32开发板种类繁多，我们最终选择了ESP32 DevKitC V4作为核心控制器。这款开发板具有以下优势：

内置USB转串口芯片，方便调试和程序下载
引出所有GPIO引脚，便于扩展外设
板载稳压电路，可直接使用5V电源供电
价格适中，适合教学和实验使用

注意：不同厂商的ESP32开发板引脚定义可能略有差异，使用前务必查阅对应开发板的原理图。

2.2 电机驱动电路设计

机器人采用两个直流减速电机作为驱动单元，通过L298N电机驱动模块控制。这个经典的双H桥驱动芯片可以同时控制两个直流电机，支持PWM调速和正反转控制。

接线方案如下：

电机A连接OUT1和OUT2
电机B连接OUT3和OUT4
使能端ENA和ENB分别连接ESP32的PWM输出引脚
方向控制IN1-IN4连接ESP32的GPIO

2.3 传感器系统集成

为了实现基本的避障和巡线功能，我们为机器人配备了以下传感器：

超声波测距模块HC-SR04（前向避障）
红外反射式传感器TCRT5000（地面巡线检测）
MPU6050六轴姿态传感器（运动状态监测）

这些传感器通过I2C和GPIO与ESP32连接，构成了机器人的感知系统。

3. 软件开发环境配置

3.1 Arduino IDE环境搭建

虽然ESP32支持多种开发方式，但我们选择了最易上手的Arduino IDE作为开发环境。配置步骤如下：

安装最新版Arduino IDE（1.8.x以上）

在首选项中添加ESP32开发板管理网址：

code复制https://dl.espressif.com/dl/package_esp32_index.json

通过开发板管理器安装"esp32"平台
选择正确的开发板型号和端口

3.2 必要库文件安装

为了实现各项功能，我们需要安装以下库：

ESP32Servo（用于PWM控制）
NewPing（超声波传感器驱动）
MPU6050_tockn（姿态传感器数据处理）
WiFi（无线通信功能）

这些库可以通过Arduino的库管理器直接搜索安装，或者从GitHub下载后手动安装。

4. 核心功能实现

4.1 电机PWM控制

直流电机的速度控制通过PWM实现。ESP32的LEDC外设提供了16个PWM通道，配置步骤如下：

cpp复制// 电机PWM初始化
void motorInit() {
  ledcSetup(MOTOR_PWM_CHANNEL_A, MOTOR_PWM_FREQ, MOTOR_PWM_RESOLUTION);
  ledcAttachPin(MOTOR_A_PWM_PIN, MOTOR_PWM_CHANNEL_A);
  
  ledcSetup(MOTOR_PWM_CHANNEL_B, MOTOR_PWM_FREQ, MOTOR_PWM_RESOLUTION);
  ledcAttachPin(MOTOR_B_PWM_PIN, MOTOR_PWM_CHANNEL_B);
}

// 设置电机速度
void setMotorSpeed(int motor, int speed) {
  speed = constrain(speed, -255, 255);
  if(motor == MOTOR_A) {
    if(speed >= 0) {
      digitalWrite(MOTOR_A_IN1, HIGH);
      digitalWrite(MOTOR_A_IN2, LOW);
    } else {
      digitalWrite(MOTOR_A_IN1, LOW);
      digitalWrite(MOTOR_A_IN2, HIGH);
    }
    ledcWrite(MOTOR_PWM_CHANNEL_A, abs(speed));
  } else {
    // 类似处理电机B
  }
}

提示：PWM频率不宜设置过高，一般500Hz-1kHz为宜。频率过高可能导致电机驱动芯片发热。

4.2 超声波避障实现

超声波测距模块提供了机器人避障的基础数据。我们使用NewPing库简化了测距过程：

cpp复制#include <NewPing.h>

#define TRIGGER_PIN  12
#define ECHO_PIN     14
#define MAX_DISTANCE 200

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);

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

void loop() {
  delay(50);
  unsigned int distance = sonar.ping_cm();
  Serial.print("Distance: ");
  Serial.print(distance);
  Serial.println("cm");
  
  if(distance > 0 && distance < 20) {
    // 执行避障动作
    avoidObstacle();
  }
}

4.3 无线控制实现

ESP32的WiFi功能允许我们通过手机或电脑远程控制机器人。我们实现了一个简单的Web控制界面：

cpp复制#include <WiFi.h>
#include <WebServer.h>

const char* ssid = "RobotAP";
const char* password = "12345678";

WebServer server(80);

void handleRoot() {
  String html = "<html><body>";
  html += "<h1>Robot Controller</h1>";
  html += "<a href='/forward'><button>Forward</button></a><br>";
  html += "<a href='/stop'><button>Stop</button></a><br>";
  html += "</body></html>";
  
  server.send(200, "text/html", html);
}

void setup() {
  WiFi.softAP(ssid, password);
  
  server.on("/", handleRoot);
  server.on("/forward", [](){
    setMotorSpeed(MOTOR_A, 200);
    setMotorSpeed(MOTOR_B, 200);
    server.send(200, "text/plain", "Moving forward");
  });
  
  server.begin();
}

void loop() {
  server.handleClient();
}

5. 运动控制算法

5.1 差速转向原理

两轮差速驱动机器人的转向是通过左右轮速度差实现的。当两轮速度相同时，机器人直线运动；当速度不同时，机器人会向低速轮一侧转向。

转向角度计算公式：

code复制转弯半径 R = L/2 * (Vr + Vl)/(Vr - Vl)
其中：
L - 两轮间距
Vr - 右轮速度
Vl - 左轮速度

5.2 PID速度控制

为了实现精确的速度控制，我们为每个电机实现了PID控制器：

cpp复制class PIDController {
private:
  float kp, ki, kd;
  float integral, prevError;
  long lastTime;
  
public:
  PIDController(float p, float i, float d) : kp(p), ki(i), kd(d) {
    integral = 0;
    prevError = 0;
    lastTime = millis();
  }
  
  float compute(float setpoint, float input) {
    long now = millis();
    float dt = (now - lastTime) / 1000.0;
    lastTime = now;
    
    float error = setpoint - input;
    integral += error * dt;
    float derivative = (error - prevError) / dt;
    prevError = error;
    
    return kp * error + ki * integral + kd * derivative;
  }
};

PIDController leftMotorPID(1.0, 0.01, 0.1);
PIDController rightMotorPID(1.0, 0.01, 0.1);

5.3 运动控制状态机

机器人行为通过状态机管理，简化了复杂行为的实现：

cpp复制enum RobotState {
  STATE_IDLE,
  STATE_FORWARD,
  STATE_BACKWARD,
  STATE_TURN_LEFT,
  STATE_TURN_RIGHT,
  STATE_AVOID
};

RobotState currentState = STATE_IDLE;

void updateState() {
  switch(currentState) {
    case STATE_FORWARD:
      setMotorSpeed(MOTOR_A, 200);
      setMotorSpeed(MOTOR_B, 200);
      break;
      
    case STATE_AVOID:
      // 避障行为
      avoidObstacle();
      break;
      
    // 其他状态处理
  }
}

6. 调试与优化

6.1 串口调试技巧

ESP32提供了丰富的调试输出功能。除了基本的Serial.print外，还可以使用以下技巧：

使用Serial.printf格式化输出：

cpp复制Serial.printf("Motor A: %d, Motor B: %d\n", speedA, speedB);

条件调试输出：

cpp复制#define DEBUG 1

void debugPrint(String message) {
  #if DEBUG
  Serial.println(message);
  #endif
}

使用不同的串口：

cpp复制Serial2.begin(115200, SERIAL_8N1, 16, 17);
Serial2.println("Debug message");

6.2 性能优化建议

减少延迟函数使用：避免使用delay()，改用millis()实现非阻塞延时

cpp复制unsigned long previousMillis = 0;
const long interval = 1000;

void loop() {
  unsigned long currentMillis = millis();
  if(currentMillis - previousMillis >= interval) {
    previousMillis = currentMillis;
    // 执行定时任务
  }
}

优化WiFi功耗：当不需要WiFi时，可以关闭以节省电量
```
cpp复制WiFi.mode(WIFI_OFF);
```

使用FreeRTOS任务：ESP32支持多任务，可以将不同功能分配到不同核心

cpp复制xTaskCreatePinnedToCore(
  taskFunction,  // 任务函数
  "TaskName",    // 任务名称
  10000,         // 堆栈大小
  NULL,          // 参数
  1,             // 优先级
  NULL,          // 任务句柄
  0              // 核心编号
);