从零到一：基于STM32的PID平衡车实战笔记

1. PID算法基础：从理论到实践

第一次接触PID控制是在大学实验室，看着学长用STM32做的平衡车稳稳立在那里，当时就觉得这玩意儿太神奇了。后来自己动手做才发现，PID既是控制领域的经典算法，也是新手最容易踩坑的地方。

简单来说，PID就是让实际值快速、稳定地跟踪目标值的一套方法。想象一下你开车时的定速巡航：设定120km/h后，系统会自动调节油门，让车速保持在目标值附近。这个调节过程就是PID在发挥作用。在平衡车项目中，我们要让车体角度始终维持在垂直位置，本质上也是在做一个"角度巡航"。

PID由三个部分组成：

• 比例项(P)：根据当前误差大小进行调节，误差越大调节力度越大
• 积分项(I)：累积历史误差，专门对付那些顽固的稳态误差
• 微分项(D)：预测误差变化趋势，提前踩刹车防止超调

这三个参数就像团队里的三个成员：P是急性子，发现问题马上处理；I是慢性子，慢慢积累力量解决问题；D是预言家，总能提前预判问题走向。把他们配合好，系统就能又快又稳地达到目标。

2. STM32硬件平台搭建

做平衡车最常用的就是STM32F103系列，价格便宜性能足够。我用的是一块蓝色pill开发板，加上MPU6050六轴传感器和TB6612电机驱动模块，总成本不到100元。

硬件连接要注意几个关键点：

1. 电源部分：电机启动瞬间电流很大，建议主控板和电机驱动分开供电。我用的是两节18650电池，通过AMS1117给STM32供电，电池直接接电机驱动。
2. 传感器安装：MPU6050要尽量靠近车体中心轴，安装倾斜会导致零点偏移。我第一次做的时候用热熔胶固定，结果车子一动传感器就歪了，后来改用3D打印支架才解决。
3. 电机选择：建议用带编码器的减速电机，转速在200-300转/分钟比较合适。我用的是TT马达，实测发现扭力不够，后来换了N20电机才好些。

提示：焊接电机线时记得先上锡，直接拧在一起容易接触不良导致电机抖动。

3. 软件框架设计

代码结构对后期调参影响很大。我的程序主要分为三层：

1. 硬件驱动层：处理PWM输出、编码器读取、MPU6050数据获取
2. 算法层：实现PID计算和滤波算法
3. 应用层：处理用户输入和状态显示

重点说说PID算法的实现。在STM32上一般用定时器中断来定期计算PID，我的设置是5ms一次。关键代码如下：

typedef struct { float Kp, Ki, Kd; float error, lastError; float integral, derivative; float output; } PID_TypeDef; void PID_Calculate(PID_TypeDef *pid, float target, float actual) { pid->error = target - actual; pid->integral += pid->error; pid->derivative = pid->error - pid->lastError; pid->output = pid->Kp * pid->error + pid->Ki * pid->integral + pid->Kd * pid->derivative; pid->lastError = pid->error; }

这段代码有几个优化点：

1. 对积分项做了限幅，防止积分饱和
2. 增加了输出限幅，避免给电机过大PWM
3. 加入了死区处理，微小误差时不调节

4. PID参数整定实战

调参是平衡车项目最磨人的环节。我的经验是先调P，再调D，最后加少量I。具体步骤：

4.1 比例项调试

1. 把所有参数设为0，慢慢增大Kp直到车体开始小幅振荡
2. 记录这个临界值Kp0，实际使用的Kp取0.6倍Kp0
3. 测试发现Kp=12时车体开始抖动，最后选定Kp=7.2

4.2 微分项调试

1. 保持Kp不变，逐步增加Kd
2. 观察车体振荡是否减弱，响应速度是否改善
3. 我的参数是Kd=0.5时效果最好，再大会导致响应迟钝

4.3 积分项调试

平衡车对积分项很敏感，我的经验是：

1. Ki值要非常小，一般取Kp的1/100~1/50
2. 必须加积分限幅，我设置的是±20
3. 最终Ki=0.15时效果不错

调试时遇到一个典型问题：车体总是往一边偏。检查发现是MPU6050安装有轻微倾斜，后来在代码里加了零点校准函数解决。

5. 常见问题排查

做平衡车肯定会遇到各种异常情况，分享几个我踩过的坑：

1. 电机抖动严重：检查电源是否足够，我的第一版用USB供电，根本带不动电机。后来改用电池直接供电就好了。

2. 角度测量漂移：MPU6050需要做软件滤波。我试过互补滤波和卡尔曼滤波，最终选择了一阶互补滤波，在精度和计算量之间取得了平衡。

3. 响应迟钝：可能是微分项太大，或者PID计算周期太长。我把中断周期从10ms改为5ms后明显改善。

4. 站立不稳：重点检查机械结构重心是否够低。我在车体下方加了配重块，稳定性大幅提升。

6. 进阶优化方向

基础功能实现后，还可以做这些优化：

1. 加入速度环控制，实现前后移动
2. 增加蓝牙遥控功能
3. 用OLED显示实时参数
4. 开发上位机调参工具

最让我惊喜的是加入了一个简单的模糊控制算法，与PID配合使用后，车子居然能在轻微坡道上保持平衡。这也让我明白，PID不是万能的，根据场景选择合适的控制策略才是关键。

调参过程中最大的体会是：理论计算只能给出大致范围，真正的黄金参数还是要靠实验摸索。有时候半夜调通一个参数，看着小车稳稳立住的那一刻，那种成就感真是无法形容。