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解决了问题。
4. PID参数整定技巧
4.1 调试三部曲
先调直立环：
- Kp从5开始，每次增加2，直到小车能短暂站立
- Kd从0.5开始，抑制振荡
- Ki最后加，值要小（0.001左右）
再调速度环：
- 目标速度设为0
- Kp从0.1开始，观察小车是否会在平衡位置附近漂移
最后调转向环：
- 用手轻轻扭转小车，观察回正速度
- Kp通常比速度环大20%
4.2 常见问题解决
问题1：小车剧烈振荡
- 可能原因：Kp太大或Kd太小
- 解决方法：先降低Kp，再适当增加Kd
问题2：小车缓慢倾斜倒地
- 可能原因：Kp不足或Ki太小
- 解决方法：逐步增加Kp，若无效再加少量Ki
问题3：转向时车身倾斜
- 可能原因：转向环和直立环耦合
- 解决方法：降低转向环Kp，或在转向时动态调整直立环目标角度
有个实用技巧：在调试初期可以给小车加个支架，用橡皮筋轻轻拉住，这样即使参数不合适也不会摔坏小车。我第一个小车就是因为没做保护，调试时把电机轴都摔弯了。
