3步打造ESP32自平衡车：从0到1掌握姿态控制核心技术

你是否遇到过这些问题：自平衡车启动就倾倒？运行时左右摇晃难以稳定？调整PID参数如同猜谜？本文将用ESP32+MPU6050组合，通过模块化设计带你构建稳定的自平衡系统，让你的小车像芭蕾舞者一样优雅平衡。

一、核心原理：自平衡的秘密

1.1 平衡控制的"神经系统"

自平衡车的稳定运行依赖三个核心环节：

• 姿态感知：IMU传感器（即运动姿态测量单元）如同内耳，实时检测车体倾角
• 大脑决策：PID控制器像平衡木运动员的小脑，计算所需调整量
• 执行机构：电机驱动模块如同肌肉，根据指令调整转速

1.2 PID控制器：平衡的艺术

PID控制器就像调酒师：

• 比例(P)：直接根据偏差量调酒，比例越大味道越浓烈
• 积分(I)：慢慢加入调料，消除长期偏差
• 微分(D)：预判味道变化趋势，提前调整

三者的完美配比才能调出"平衡"这杯美酒。

二、实践步骤：从零开始构建系统

2.1 准备工具

硬件清单：

• ESP32开发板（推荐带IMU接口的型号）
• MPU6050六轴传感器
• L298N电机驱动模块
• 直流减速电机×2及车轮
• 7.4V锂电池

2.2 接线指南

I2C传感器接线：

ESP32        MPU6050
SDA (21)  →  SDA
SCL (22)  →  SCL
3.3V      →  VCC
GND       →  GND

电机驱动接线：

• IN1/IN2 → GPIO14/GPIO15（左电机方向）
• IN3/IN4 → GPIO27/GPIO26（右电机方向）
• ENA/ENB → GPIO12/GPIO13（PWM控制）

2.3 代码实现

1. 传感器初始化

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

MPU6050 mpu;
float angle = 0;  // 当前倾角

void setup() {
  Wire.begin(21, 22);  // I2C引脚初始化
  mpu.initialize();
  mpu.setXGyroOffset(220);  // 校准偏移值
}

2. 数据融合算法

void loop() {
  int16_t ax, ay, az, 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;
  delay(10);
}

3. PID控制实现

class PIDController {
  float kp, ki, kd;
  float error, integral, derivative, lastError;
  
public:
  PIDController(float p, float i, float d) : kp(p), ki(i), kd(d) {}
  
  float compute(float target, float current) {
    error = target - current;
    integral += error * 0.01;  // 积分项
    derivative = (error - lastError) / 0.01;  // 微分项
    lastError = error;
    return kp * error + ki * integral + kd * derivative;
  }
};

三、调试优化：让平衡更稳定

3.1 PID参数调试表

参数	作用	推荐范围	调试技巧
Kp	控制灵敏度	3.0-8.0	从小逐渐增大，出现轻微震荡时停止
Ki	消除静态误差	0.01-0.2	最后添加，避免积分饱和
Kd	抑制震荡	0.1-1.0	通常为Kp的1/10

3.2 实用调试技巧

1. 倾角校准：将车体放置水平，记录初始角度作为零点
2. 电机平衡：确保左右电机转速一致，可通过PWM微调
3. 电源管理：使用稳压模块，避免电池电压下降影响性能

四、常见误区

⚠️ 传感器安装错误：IMU必须与车体纵轴平行，否则会引入测量偏差 ⚠️ PID参数顺序：必须先调P，再调D，最后加I，顺序错误会导致系统不稳定 ⚠️ 供电不足：电机启动时电流突变，需选用至少2A输出能力的电源

五、社区交流

1. 参数分享：你的自平衡车PID参数是多少？在平整地面能稳定多久？
2. 硬件优化：如何通过机械结构设计减少控制难度？欢迎分享你的方案

完整项目代码可参考：idf_component_examples/
官方硬件设计文档：docs/