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