3步打造ESP32自平衡车：从零基础到直立行走的实战指南

2026-04-12 09:35:43作者：裴锟轩Denise

你是否想过用一块ESP32开发板就能搭建一台会自己保持平衡的小车？本文将带你通过模块化开发的方式，从核心原理到实际代码，一步步实现ESP32自平衡车的姿态控制。我们会用通俗的类比解释复杂的控制算法，让你轻松掌握传感器数据融合、PID参数调优等关键技术，最终打造出一台能稳定直立的智能小车。

理解自平衡的核心原理

自平衡车之所以能像踩高跷一样稳稳站立，关键在于它能实时"感知"自己的姿态并快速"调整"。想象你站在平衡木上，眼睛相当于传感器，大脑相当于控制器，腿就是执行器——ESP32自平衡车的工作原理与此类似。

姿态感知系统

自平衡车的"眼睛"是IMU传感器，它通常包含加速度计和陀螺仪。加速度计能检测重力方向，就像你闭眼时能通过身体感觉知道自己是否倾斜；陀螺仪则能测量旋转速度，如同你能感知身体晃动的快慢。这两种传感器的数据需要融合才能得到准确的姿态角。

图1：ESP32作为I2C主设备连接多个从设备的示意图，IMU传感器通常通过I2C总线与ESP32通信

平衡控制机制

当IMU检测到车体倾斜时，ESP32会计算出需要多大的力量来纠正这个倾斜——这就是PID控制器的工作。可以把PID控制器想象成一位经验丰富的平衡木教练：

比例(P)：倾斜越严重，纠正力度越大（就像教练看到你倾斜多了会喊"用力！"）
积分(I)：如果小倾斜一直存在，会慢慢积累纠正力量（类似教练发现你总往一边偏，会持续提醒你调整）
微分(D)：根据倾斜变化速度调整纠正强度（好比教练看到你晃得太快会说"慢点！"）

动手搭建自平衡车系统

准备硬件组件

你需要准备这些核心部件：

ESP32开发板（推荐带IMU接口的型号）
MPU6050六轴IMU传感器
两个直流减速电机
L298N电机驱动模块
锂电池组（7.4V）
车底盘和轮子

连接硬件系统

按照以下步骤连接各组件：

将MPU6050通过I2C接口连接到ESP32（SDA->GPIO21，SCL->GPIO22）
电机驱动模块L298N的控制引脚连接到ESP32的PWM端口
电机电源使用锂电池，ESP32可从驱动模块取电
确保所有GND连接在一起

图2：ESP32外设连接框图，展示了GPIO矩阵如何连接各种外设

编写核心代码

首先初始化IMU传感器：

#include <Wire.h>
#include <MPU6050.h>

MPU6050 mpu;
float angle = 0; // 初始角度设为0度（平衡位置）

void setupIMU() {
  Wire.begin();
  if (!mpu.initialize()) {
    // 传感器初始化失败处理
    while (1) delay(100);
  }
  // 校准传感器（实际使用时需要执行校准程序）
}

接着实现数据融合算法：

void updateAngle() {
  int16_t ax, ay, az;
  int16_t gx, gy, gz;
  mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
  
  // 加速度计计算角度（类似用水平仪测倾斜）
  float accelAngle = atan2(ax, az) * RAD_TO_DEG;
  // 陀螺仪计算角度变化（类似用角速度积分）
  float gyroAngle = angle + gy * 0.001; // 0.001是采样时间（秒）
  
  // 互补滤波融合两种角度（权重分配）
  angle = 0.98 * gyroAngle + 0.02 * accelAngle;
}

然后实现PID控制器：

class BalanceController {
private:
  float kp, ki, kd;
  float error, lastError, integral, derivative;
  unsigned long lastTime;

public:
  BalanceController(float p, float i, float d) : kp(p), ki(i), kd(d) {
    lastTime = millis();
  }

  float calculate(float target, float current) {
    unsigned long now = millis();
    float dt = (now - lastTime) / 1000.0; // 计算时间间隔（秒）
    lastTime = now;

    error = target - current;
    integral += error * dt;
    derivative = (error - lastError) / dt;
    lastError = error;

    // 限制积分项防止饱和
    integral = constrain(integral, -100, 100);
    
    return kp * error + ki * integral + kd * derivative;
  }
};

最后是主控制循环：

BalanceController balancePID(4.5, 0.05, 0.3); // PID参数
const int motorPins[2][3] = {{14, 15, 12}, {27, 26, 13}}; // 左右电机引脚

void setup() {
  setupIMU();
  // 初始化电机引脚为输出模式
  for (int i = 0; i < 2; i++) {
    for (int j = 0; j < 3; j++) {
      pinMode(motorPins[i][j], OUTPUT);
    }
  }
}

void loop() {
  updateAngle(); // 更新当前倾角
  float control = balancePID.calculate(0, angle); // 计算控制量
  
  // 控制左右电机（简化版）
  setMotorSpeed(0, control); // 左电机
  setMotorSpeed(1, control); // 右电机
  
  delay(10); // 控制周期10ms
}

void setMotorSpeed(int motor, float speed) {
  // 根据speed值控制电机正反转和速度
  // 实际实现需要PWM输出和方向控制逻辑
}