从零构建基于MPU6050的智能平衡小车：硬件选型与姿态解算实战

平衡小车一直是创客圈经久不衰的经典项目，它巧妙地将传感器技术、控制算法和机电系统融为一体。作为核心传感器，MPU6050以其高集成度和性价比成为多数创客的首选。今天我们就从硬件搭建到代码实现，完整走通这个充满成就感的项目。

1. 硬件架构设计与核心元件选型

1.1 GY-521模块的硬件特性解析

GY-521作为MPU6050的经典载板，其设计充分考虑了开发便利性：

• 电源设计：支持3.3V-5V宽电压输入，与多数开发板兼容
• 接口布局：8Pin标准排针引出所有功能接口
• 地址选择：AD0引脚电平决定I2C地址(0x68/0x69)
• 中断输出：INT引脚可配置为数据就绪或运动检测中断

提示：实际使用中发现，某些廉价GY-521模块的焊盘可能存在虚焊问题，上电前建议先用万用表检查电源与地是否短路。

1.2 电机驱动方案对比

平衡小车需要快速响应控制信号，常见的驱动方案有：

cpp复制// 典型TB6612驱动代码片段
#define PWMA 5   // 电机A PWM控制
#define AIN1 6   // 电机A方向1
#define AIN2 7   // 电机A方向2

void setMotor(int speed) {
  digitalWrite(AIN1, speed > 0 ? HIGH : LOW);
  digitalWrite(AIN2, speed > 0 ? LOW : HIGH);
  analogWrite(PWMA, abs(speed));
}

1.3 车体结构设计要点

• 重心高度应低于轮轴中心线
• 建议使用3D打印件或铝合金框架
• 轮径选择8-10cm为宜，过大影响响应速度
• 电池推荐18650锂电池组（7.4V）

2. MPU6050传感器数据采集与处理

2.1 传感器初始化配置

MPU6050需要正确配置才能输出可用数据：

cpp复制#include "Wire.h"
#define MPU_ADDR 0x68

void setupMPU() {
  Wire.begin();
  Wire.beginTransmission(MPU_ADDR);
  Wire.write(0x6B);  // PWR_MGMT_1寄存器
  Wire.write(0);     // 解除休眠模式
  Wire.endTransmission(true);
  
  // 配置加速度计量程±4g
  Wire.beginTransmission(MPU_ADDR);
  Wire.write(0x1C);  
  Wire.write(0x08);
  Wire.endTransmission();
  
  // 配置陀螺仪量程±500°/s
  Wire.beginTransmission(MPU_ADDR);
  Wire.write(0x1B);  
  Wire.write(0x08);
  Wire.endTransmission();
}

2.2 原始数据读取与校准

传感器上电后需要进行简单的零偏校准：

1. 将模块静止放置在水平面上
2. 连续采集100次数据取平均值
3. 存储各轴的零偏值
4. 后续读数减去对应零偏

cpp复制struct SensorData {
  float accX, accY, accZ;
  float gyroX, gyroY, gyroZ;
};

SensorData readCalibratedData() {
  SensorData raw = readRawData();
  static SensorData offset = { -0.12, 0.05, 0.33, 1.2, -0.8, 0.4 };
  
  raw.accX -= offset.accX;
  raw.accY -= offset.accY;
  // ...其他轴同理
  
  return raw;
}

2.3 姿态解算算法选择

常见姿态解算方法对比：

• 互补滤波：计算量小适合8位MCU
• 卡尔曼滤波：精度高但参数调校复杂
• DMP内置解算：直接输出四元数（推荐方案）

启用DMP功能的代码片段：

cpp复制void enableDMP() {
  Wire.beginTransmission(MPU_ADDR);
  Wire.write(0x6A);  // USER_CTRL寄存器
  Wire.write(0x04);  // 复位DMP
  Wire.endTransmission();
  
  delay(50);
  
  Wire.beginTransmission(MPU_ADDR);
  Wire.write(0x6A);
  Wire.write(0x80);  // 使能DMP
  Wire.endTransmission();
}

3. 控制算法实现与参数整定

3.1 PID控制器设计

平衡小车的核心是角度环PID控制：

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

3.2 参数调试经验分享

调试时应遵循以下顺序：

1. 先调P值直到小车能勉强维持不倒
2. 加入D值抑制振荡
3. 最后微调I值消除稳态误差
4. 典型参数范围：
   • P: 15-25
   • I: 0.1-0.5
   • D: 0.5-2.0

注意：不同车体结构的参数差异很大，建议每次只调整一个参数，变化幅度控制在±10%。

3.3 速度环与转向环设计

进阶控制可增加：

• 速度环：通过编码器反馈实现定速
• 转向环：通过陀螺仪Z轴数据控制差速

cpp复制void balanceLoop() {
  static PIDController anglePID(20, 0.3, 1.2);
  static PIDController speedPID(10, 0.1, 0);
  
  float angle = getFilteredAngle();  // 获取DMP解算的角度
  float speed = getMotorSpeed();     // 编码器反馈
  
  float output = anglePID.compute(0, angle, 0.01);
  output += speedPID.compute(targetSpeed, speed, 0.01);
  
  setMotor(output);
}

4. 系统集成与调试技巧

4.1 电源管理方案

推荐采用双电源方案：

• 电机驱动使用7.4V锂电池
• 控制电路通过降压模块供电
• 重要提示：数字地与电机地需单点连接

4.2 常见故障排查

调试中遇到的典型问题：

1. 传感器数据异常：

   • 检查I2C上拉电阻（通常4.7kΩ）
   • 确认电源无毛刺（建议并联100μF电容）

2. 电机响应迟钝：

   • 提高PWM频率（建议8kHz以上）
   • 检查驱动芯片散热

3. 系统振荡失控：

   • 降低P值增加D值
   • 检查机械结构是否松动

4.3 性能优化建议

• 将关键代码放在定时中断中确保执行时序
• 使用硬件I2C提升通信可靠性
• 添加蓝牙模块实现参数无线调试

cpp复制// 示例：定时中断服务程序
void TC5_Handler() {
  static uint32_t lastTime = 0;
  float dt = (micros() - lastTime) / 1e6;
  lastTime = micros();
  
  balanceLoop();  // 执行控制算法
  
  REG_TC5_INTFLAG = TC_INTFLAG_OVF;  // 清除中断标志
}

5. 项目扩展与进阶方向

完成基础平衡后，可以考虑：

• 手机蓝牙遥控：通过HC-05模块实现
• 自主导航：增加超声波或红外测距
• 运动轨迹记录：添加SD卡存储模块
• ROS集成：移植到树莓派实现SLAM

一个调试完成的小车，其响应速度应该能做到：当以10°角度倾斜车体时，车轮能在0.3秒内做出正确响应并恢复平衡。这需要机械、电子和控制算法的完美配合——而这正是创客项目的魅力所在。