从零到一：基于STM32与MPU6050的两轮自平衡小车实战指南
1. 项目背景与核心原理
两轮自平衡小车听起来像是高科技产物，但其实它的核心原理并不复杂。想象一下杂技演员走钢丝的场景——通过不断调整身体重心来保持平衡。这个小车的工作原理也类似，只不过把"大脑"换成了STM32单片机，"小脑"换成了MPU6050传感器，"肌肉"则是两个直流电机。
我去年第一次尝试做这个项目时，最大的误区就是以为只要把传感器和电机接上就能自动平衡。结果通电瞬间小车就直接"躺平"，后来才发现姿态解算和控制算法才是真正的灵魂。MPU6050输出的原始数据就像醉酒人的胡言乱语，需要经过卡尔曼滤波"醒酒"后才能用。而PID控制就像教小朋友骑自行车，P参数决定扶车把的力度，D参数控制纠正动作的快慢，I参数则负责消除长期偏差。
这个项目最迷人的地方在于，你能亲眼看到数学公式如何转化为物理运动。当调整好PID参数后，小车从东倒西歪到稳稳直立的那一刻，简直比通关游戏还让人兴奋。建议初学者先重点理解这几个概念：
- 姿态检测：MPU6050的加速度计测量倾斜角度，陀螺仪测量角速度
- 数据融合：卡尔曼滤波结合两种传感器的优势，消除噪声和漂移
- 闭环控制：PID算法根据当前状态不断调整电机输出
2. 硬件搭建全攻略
2.1 元器件选型避坑指南
第一次买元器件时，我在淘宝上看到9.9包邮的MPU6050模块就下单了，结果采样时数据跳得比心电图还剧烈。后来才发现要选带运动处理引擎的MPU6050模块（价格通常在15-25元），这种模块内部有硬件滤波电路。其他关键部件的选型要点：
- 主控芯片：STM32F103C8T6（蓝桥杯开发板同款）性价比最高，注意要买正版芯片
- 电机驱动：TB6612比L298N效率高、发热小，支持1.2A持续电流
- 直流电机：N20减速电机要选编码器版本（6V/100RPM），空载电流<100mA
- 电池：7.4V锂电池组要带保护板，容量建议2000mAh以上
特别提醒：别贪便宜买所谓的"STM32学习套件"，里面很多配件根本用不上。我建议单独采购这些核心部件，总成本可以控制在150元以内。
2.2 电路设计实战技巧
焊接电路时最容易犯的错误就是电源问题。我的第一个版本因为3.3V和5V混接，导致MPU6050时不时抽风。后来用万用表挨个测量才发现问题。分享几个实用技巧：
- 电源隔离：电机驱动部分和控制系统最好分开供电，至少要在PCB上划分模拟地和数字地
- 滤波电容：每个芯片的VCC引脚都要加0.1μF陶瓷电容，电机两端并联100μF电解电容
- 信号保护：PWM信号线要加100Ω电阻，防止电机反向电动势损坏单片机
附上我的接线清单：
- MPU6050：SCL→PB6，SDA→PB7，INT→PB4
- 电机驱动：AIN1→PA4，AIN2→PA5，BIN1→PA6，BIN2→PA7
- 蓝牙模块：TX→PA9，RX→PA10
3. 软件设计深度解析
3.1 卡尔曼滤波的简化实现
很多教程把卡尔曼滤波讲得高深莫测，其实对于自平衡小车，我们只需要知道它能把"颠三倒四"的传感器数据变成"靠谱"的角度值。这是我简化后的实现：
// 超简版卡尔曼滤波 float Simple_Kalman(float acc_angle, float gyro_rate, float dt) { static float angle = 0; static float bias = 0; const float Q_angle = 0.001; // 过程噪声 const float R_angle = 0.5; // 测量噪声 // 预测阶段 angle += (gyro_rate - bias) * dt; // 更新阶段 float err = acc_angle - angle; float K = 0.1; // 固定增益系数 angle += K * err; bias += 0.01 * err; return angle; }这个版本虽然不如完整卡尔曼滤波精确，但对初学者更友好，实测平衡效果也不错。当小车静止时，主要相信加速度计的数据；运动时则更依赖陀螺仪，避免离心力造成的角度误判。
3.2 PID控制的三环架构
完整的控制系统需要三个PID环协同工作：
- 直立环（最内层）：快速响应角度变化，频率建议100Hz
- 速度环（中间层）：调节整体速度，频率20-50Hz
- 转向环（最外层）：处理转向指令，频率10-20Hz
// 三环PID控制示例 void Control_Loop() { // 获取传感器数据 MPU6050_GetData(&acc, &gyro); float angle = Kalman_Filter(acc.x, gyro.x, 0.01); // 计算各环输出 balance_out = PID_Balance(0, angle, gyro.x); // 目标角度0° speed_out = PID_Speed(target_speed, encoder_speed); turn_out = PID_Turn(target_turn, gyro.z); // 合成最终输出 left_motor = balance_out + speed_out - turn_out; right_motor = balance_out + speed_out + turn_out; Motor_Output(left_motor, right_motor); }调试时要遵循"先内环后外环"的原则：先调好直立环能让小车稳定5秒以上，再加速度环；最后加转向环。每个环都要先调P参数，出现震荡再加D，最后微调I。
4. 调试技巧与性能优化
4.1 PID参数整定的玄学
PID调参就像中医把脉，需要观察小车的"症状"来对症下药：
- 站不稳：增大P值，相当于扶得更用力
- 来回晃：适当增加D值，相当于用手缓冲
- 慢慢倾斜：加一点I值，相当于微调重心
我的经验参数范围（供参考）：
| 控制环 | Kp | Ki | Kd |
|---|---|---|---|
| 直立环 | 20-40 | 0-0.5 | 0.5-2 |
| 速度环 | 1-3 | 0.01-0.1 | 0-0.5 |
| 转向环 | 3-6 | 0 | 0.1-0.3 |
建议准备个笔记本记录每次参数调整的效果。有个小技巧：用蓝牙模块发送实时数据到手机，比串口打印更直观。
4.2 常见问题排查清单
根据我帮学弟学妹调试的经验，90%的问题出在这些地方：
小车直接倒向一边
- 检查MPU6050安装方向是否正确
- 重新校准传感器（水平放置时执行校准程序）
- 确认电机转向是否正确（前进时两个轮子应该同向）
电机发出奇怪响声但不转
- 测量电机驱动芯片供电电压（至少5V）
- 检查PWM频率是否在10-20kHz范围内
- 确认STBY引脚已接高电平
平衡时突然抽搐
- 降低PID的D参数
- 在代码中加入输出限幅（比如±200）
- 检查电池电压是否过低（低于6V时性能下降明显）
最后分享一个血泪教训：永远在车轮离地的情况下第一次通电测试！我的第一个版本因为没做这个预防措施，小车直接冲下桌子摔坏了外壳。