STM32与MPU6050驱动的两轮自平衡小车：从硬件搭建到PID调参实战-程序员充电站

1. 两轮自平衡小车的工作原理

两轮自平衡小车本质上是一个倒立摆系统，这种结构天生就不稳定，需要通过实时控制才能保持平衡。想象一下用手指顶着一根直立的木棍，你需要不断移动手指来调整木棍的位置——这就是自平衡小车的工作原理，只不过用电机和传感器代替了人的手指和眼睛。

核心控制流程是这样的：MPU6050传感器就像小车的"内耳"，实时感知车身倾斜角度和角速度。STM32微控制器则相当于"大脑"，通过卡尔曼滤波算法处理传感器数据，计算出精确的姿态信息。然后PID控制算法根据当前姿态偏差，计算出需要给电机输出的PWM信号，驱动车轮做出相应运动来维持平衡。

在实际项目中，我们通常采用三环PID控制结构：

直立环（最内环）：快速响应角度变化，维持基本平衡
速度环（中间环）：防止小车因微小偏移而持续移动
转向环（最外环）：实现转向控制

这三个控制环需要按照从内到外的顺序依次调试，每个环的PID参数都会影响整体性能。我曾经在一个项目中，因为速度环参数设置不当，导致小车像喝醉酒一样来回摆动，最后通过降低积分项解决了问题。

2. 硬件搭建实战指南

2.1 核心元器件选型

主控芯片我推荐使用STM32F103C8T6，这款芯片价格亲民（约15元），性能足够（72MHz主频），外设丰富。有个坑要注意：一定要选正品ST芯片，我曾买到过山寨版，PWM输出不稳定导致小车抽搐。

MPU6050是姿态检测的核心，购买时注意：

选择带AUX_CL引脚的版本（方便扩展磁力计）
模块上最好有电平转换电路（5V/3.3V兼容）
优先选焊好滤波电容的版本

电机建议选用N20减速电机，减速比1:100左右。这里有个血泪教训：我曾为了省钱选了杂牌电机，结果扭矩不足，小车根本站不起来。后来换了品牌电机，立竿见影。

2.2 电路设计要点

电源设计最容易出问题。我的经验是：

锂电池要加保护板，防止过放
电机供电（7.4V）和MCU供电（3.3V）要分开稳压
在电机电源端并联1000μF以上的电容，防止电压骤降

电机驱动推荐TB6612FNG，比L298N效率高很多。接线时注意：

PWM频率建议10kHz左右（太高了MOS管发热，低了电机有啸叫）
电机负极一定要接驱动芯片的GND，不能直接接电源GND

MPU6050的I2C接线要尽量短，如果必须延长，可以加10K上拉电阻。有一次我的传感器数据老是跳变，最后发现是SDA线太长导致信号畸变。

3. 软件设计与算法实现

3.1 传感器数据处理

原始传感器数据不能直接用，需要经过三重处理：

校准：传感器水平静止时记录各轴偏移量
滤波：先用滑动平均滤波去除高频噪声
融合：用卡尔曼滤波结合加速度计和陀螺仪数据

这里给出一个简化版的卡尔曼滤波实现：

void KalmanUpdate(float acc_angle, float gyro_rate, float dt) { // 预测步骤 angle += dt * (gyro_rate - gyro_bias); P[0][0] += dt * (P[1][1]*dt - P[0][1] - P[1][0] + Q_angle); P[0][1] -= dt * P[1][1]; P[1][0] -= dt * P[1][1]; P[1][1] += Q_gyro * dt; // 更新步骤 float y = acc_angle - angle; float S = P[0][0] + R_angle; float K[2] = {P[0][0]/S, P[1][0]/S}; angle += K[0] * y; gyro_bias += K[1] * y; // 更新协方差 float P00 = P[0][0]; P[0][0] -= K[0] * P00; P[0][1] -= K[0] * P[0][1]; P[1][0] -= K[1] * P00; P[1][1] -= K[1] * P[0][1]; }

3.2 PID控制实现

直立环PID需要特别注意微分项的处理，直接使用陀螺仪数据比计算角度差分更稳定：

float BalancePID(float target, float angle, float gyro) { static float err_sum = 0; float err = target - angle; // 积分限幅防止windup err_sum += err * dt; if(err_sum > 500) err_sum = 500; else if(err_sum < -500) err_sum = -500; return Kp*err + Ki*err_sum + Kd*gyro; }

调试时建议先用蓝牙模块发送实时数据到上位机，我用这种方法发现小车在角度为0.5度时就开始加速，最后调整Kp解决了问题。