从零到稳：STM32平衡小车PID参数整定实战手记

1. 从零开始：平衡小车调试前的必修课

第一次拿到STM32平衡小车套件时，看着一堆零件和代码，我整个人都是懵的。作为一个刚入门的嵌入式爱好者，我花了整整两周时间才让这个小家伙稳稳地站起来。现在回想起来，调试过程中踩过的那些坑，都是宝贵的经验。今天我就把这些实战心得分享给大家，希望能帮你少走弯路。

首先要明确的是，平衡小车调试是个系统工程，不能一上来就急着调PID参数。就像盖房子要先打地基一样，我们需要先做好几项基础工作。第一件事就是检查电源系统。你可能觉得这太基础了，但我就栽在这个坑里。当时怎么调参数小车都站不稳，折腾了整整一天才发现是电池电压不足。用万用表一量，标称7.4V的锂电池实际只有6.3V。这里有个小技巧：最好在OLED屏上实时显示电池电压，这样能随时掌握供电情况。

第二个关键点是确定机械中值。这个步骤很多新手都会忽略，但它直接影响后续PID调试效果。具体做法是：让小车在不同倾斜角度下静止，记录MPU6050陀螺仪输出的俯仰角数据。我通常会让小车前倾到自然倒下，记录最大值；再后倾到倒下，记录最小值。这两个值的平均数就是机械中值。记得要多测几次取平均值，因为1-2度的误差都可能导致小车无法平衡。

2. PID调试三部曲：从乱调到会调

2.1 平衡环PD参数整定

终于来到重头戏——PID调试。建议按照平衡环→速度环→转向环的顺序来调。调试平衡环时，一定要先关闭其他两个环。我刚开始犯的错误就是三个环一起调，结果完全理不清因果关系。

KP参数调试有个很直观的方法：用手轻轻倾斜小车，观察轮子转动方向是否正确。记住这个口诀："前倾前进，后倾后退"。如果方向反了，直接把KP值取反就行。确定极性正确后，从小到大慢慢增加KP值。当小车出现低频摆动时，说明KP足够大了。我的小车在PWM频率10kHz下，KP最终取值在500左右。

KD参数调试要更谨慎些。先把KP归零，单独调KD。测试极性时，快速倾斜小车，轮子应该产生与倾斜方向相反的阻力。增大KD值时要注意观察，当出现高频抖动就要停止增加。我的经验是，最终使用的KD值应该是测试最大值的60%-80%。调好后，小车应该能保持3-5秒不倒下，这就算成功了。

2.2 速度环PI参数整定

速度环调试前，务必先检查编码器极性。这是个隐蔽的坑：由于电机对称安装，两个编码器的输出极性往往是相反的。我的做法是：关闭平衡环，用手转动轮子，在OLED上观察编码器数值。向前转应为正数，向后转为负数。如果发现极性不对，可以在代码中这样修正：

// 假设右电机编码器极性正确 int left_encoder = -read_encoder(LEFT_MOTOR_PORT); int right_encoder = read_encoder(RIGHT_MOTOR_PORT);

速度环的KP调试有个小技巧：根据经验，KI值取KP的1/200左右效果不错。调试时先注释掉平衡环代码，用手缓慢转动一个轮子，观察另一个轮子的反应。正确的响应应该是：当向前转动左轮时，右轮也会向前加速。如果出现相反方向运动，就要检查极性了。

2.3 转向环PD参数整定

转向环对平衡影响最小，可以放在最后调试。我的经验是：把小车放在平滑地面上，用手旋转车身，车轮应该产生阻碍旋转的力。如果发现转向太灵敏或太迟钝，适当调整KP值就行。微分参数D主要用于遥控转向时的稳定性控制，如果是自主平衡模式，可以设得小一些。

3. 那些容易被忽视的关键细节

3.1 电机死区补偿

调完PID后，我的小车还是有个奇怪现象：轻微倾斜时没反应，倾斜到一定角度才突然发力。这就是典型的死区问题。每个电机都有个最小驱动电压，低于这个值电机就不转。解决方法是在PWM输出函数里加上一个基础值：

// dead_zone是需要调试的参数 void Set_PWM(int moto1, int moto2) { PWMA = abs(moto1) + dead_zone; PWMB = abs(moto2) + dead_zone; // 方向控制代码省略... }

调试dead_zone值时，从小往大慢慢增加，直到推动小车时能立即响应，但又不会引起抖动为止。我的小车最终dead_zone值在30左右（PWM范围0-1000）。

3.2 时序优化技巧

当所有参数都调好了，小车还是站不稳？可能是时序问题在作祟。MPU6050的数据更新最快也要5ms，所以控制周期不要设得比这更短。我遇到过最坑的情况是：在中断服务函数里加了OLED显示代码，结果导致控制周期不稳定。后来把所有显示代码移到主循环，问题立刻解决。

另一个时序陷阱是浮点运算。STM32F1系列的FPU性能有限，复杂的PID运算可能超时。我的优化方案是：把所有浮点运算改为定点数运算，用整型变量代替float类型。比如把KP=0.5表示为KP=50，最后结果再除以100。

4. 调试过程中的救命技巧

调试平衡小车最痛苦的就是：改了参数不知道效果如何。我总结了一套系统化调试方法：

1. 每次只改一个参数，并记录修改前后的表现
2. 用手机慢动作视频记录小车运动状态
3. 在OLED上实时显示关键数据（角度、PWM输出等）
4. 准备个紧急开关，防止小车失控撞墙

当小车出现异常时，先检查最基本的：电池电压够吗？电机接线牢靠吗？轮子转动顺畅吗？很多时候问题就出在这些看似简单的地方。

最后分享一个参数快速收敛法：当小车完全无法平衡时，先把KP设为0，KD设为0，然后：

1. 只调KP，让小车能勉强站住1-2秒
2. 加入KD，抑制摆动
3. 最后加入速度环，实现长时间平衡

记住，PID参数没有绝对的最优值，只要小车能稳定平衡10秒以上，就是一组好参数。别陷入无止境的参数微调中，这是很多新手容易犯的完美主义错误。