零基础玩转ESP32自平衡车：从硬件到代码的完整指南

2026-02-04 05:03:52作者：卓艾滢Kingsley

你还在为平衡车控制不稳、代码复杂而烦恼吗？本文将用Arduino-ESP32平台，通过模块化设计和通俗讲解，带你从零构建稳定的自平衡控制系统。读完你将掌握：IMU传感器数据融合、PID算法参数调优、电机驱动电路设计，以及完整的代码实现方案。

硬件系统架构

自平衡车核心硬件包括ESP32主控、IMU传感器、直流电机及驱动模块。推荐使用带IMU接口的开发板如roboheart_hercules，其已定义标准I2C接口：

// I2C IMU传感器
#define IMU_SDA 21
#define IMU_SCL 22

电机驱动推荐使用L298N模块，通过ESP32的PWM接口控制转速，典型接线方式如下：

IN1/IN2 -> GPIO14/GPIO15 (左电机)
IN3/IN4 -> GPIO27/GPIO26 (右电机)
ENA/ENB -> GPIO12/GPIO13 (PWM控制)

姿态检测模块

MPU6050传感器应用

MPU6050六轴传感器是平衡控制的"平衡器官"，通过I2C总线与ESP32通信。在 sensebox_mcu_esp32s2等开发板上已预留Secondary I2C接口，初始化代码示例：

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

MPU6050 mpu;
float angle; // 融合后的倾角

void setup() {
  Wire.begin(IMU_SDA, IMU_SCL); // 使用开发板定义的I2C引脚
  mpu.initialize();
  mpu.setXGyroOffset(220); // 根据实际校准值调整
}

void loop() {
  int16_t ax, ay, az;
  int16_t gx, gy, gz;
  mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
  
  // 互补滤波融合加速度与角速度
  angle = 0.98 * (angle + gy * 0.001) + 0.02 * atan2(ax, az) * RAD_TO_DEG;
}

数据融合算法

采用互补滤波算法融合加速度计和陀螺仪数据，其中0.98和0.02为权重系数。对于更高精度需求，可参考ws_esp32_s3_matrix开发板支持的QMI8658 IMU，其内置16位ADC和运动检测功能。

PID控制算法

控制器设计

PID控制器是平衡车的"大脑"，通过计算倾角偏差来调整电机输出。核心代码实现：

class PIDController {
  private:
    float kp, ki, kd;
    float error, lastError, integral, derivative;
  
  public:
    PIDController(float p, float i, float d) : kp(p), ki(i), kd(d) {}
    
    float compute(float setpoint, float current) {
      error = setpoint - current;
      integral += error * 0.01; // 0.01s采样周期
      derivative = (error - lastError) / 0.01;
      lastError = error;
      return kp * error + ki * integral + kd * derivative;
    }
};

// 初始化PID参数（平衡控制典型值）
PIDController balancePID(5.0, 0.1, 0.2);

参数调试技巧

比例系数(Kp)：从0开始逐渐增大，直至车体出现小幅震荡
微分系数(Kd)：抑制震荡，通常为Kp的1/10~1/20
积分系数(Ki)：消除静态误差，建议取值0.01~0.1

完整代码实现

系统初始化

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

MPU6050 mpu;
PIDController balancePID(5.0, 0.1, 0.2);
PIDController speedPID(1.0, 0.05, 0.0);

const int leftMotorPins[] = {14, 15, 12}; // IN1, IN2, PWM
const int rightMotorPins[] = {27, 26, 13};

void setup() {
  Wire.begin(IMU_SDA, IMU_SCL);
  mpu.initialize();
  pinMode(leftMotorPins[0], OUTPUT);
  pinMode(leftMotorPins[1], OUTPUT);
  pinMode(leftMotorPins[2], OUTPUT);
  // 初始化右电机引脚...
}

主控制循环

void loop() {
  // 1. 读取传感器数据
  int16_t ax, ay, az, gx, gy, gz;
  mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
  
  // 2. 计算倾角
  float angle = 0.98 * (angle + gy * 0.001) + 0.02 * atan2(ax, az) * RAD_TO_DEG;
  
  // 3. PID计算
  float balanceOutput = balancePID.compute(0, angle); // 目标倾角0度
  float speedOutput = speedPID.compute(0, getWheelSpeed()); // 速度闭环控制
  
  // 4. 电机控制
  setMotorSpeed(leftMotorPins, balanceOutput + speedOutput);
  setMotorSpeed(rightMotorPins, balanceOutput - speedOutput);
  
  delay(10); // 10ms控制周期
}