STM32平衡小车PID调参血泪史：从烧毁电机到稳定运行的7个关键教训-优快云博客

STM32平衡小车PID调参实战：从电机烧毁到稳定运行的深度避坑指南

1. 平衡小车PID控制的核心逻辑

平衡小车的控制系统本质上是一个倒立摆问题，需要实时调整电机输出以维持直立状态。STM32通过MPU6050获取姿态数据，经过PID算法计算后输出PWM控制电机。这个过程中，直立环、速度环和转向环构成了串级控制系统：

// 典型的三环控制结构
Vertical_result = Vertical_PID(roll,gx);      // 直立环
Velocity_result = Velocity_PID(enc_L,enc_R);  // 速度环 
Turn_result = Turn_PID(yaw);                  // 转向环
output = Vertical_result + Velocity_result;   // 合成输出

极性判断是PID调参的首要步骤。当Kp极性正确时，车轮转动方向应与小车倾倒方向一致。一个快速验证方法：

单独给Kp赋正值，观察车轮转向
用手推动小车向前倾斜，车轮应向前转动抵抗倾倒
若方向相反，则将Kp取反

2. 硬件保护与安全调参策略

调试过程中电机烧毁是最常见的硬件事故。根据实测数据，当PWM占空比超过85%持续2秒以上，TB6612驱动芯片结温就会超过安全阈值。必须建立多重保护机制：

保护措施	实现方法	触发阈值
软件限幅	限制PWM输出绝对值	±500（根据编码器）
硬件过流保护	驱动芯片内置保护电路	1.5A(峰值)
温度监控	外接NTC热敏电阻	70℃
急停开关	外接按键触发中断	手动触发

// PWM限幅函数示例
float speed_restrict(float speed) {
    int max_speed = 500;
    if(speed >= max_speed) return max_speed;
    if(speed <= -max_speed) return -max_speed;
    return speed;
}

调试黄金法则：每次参数调整后，先用手扶住小车观察电机响应，确认无误后再放开。建议准备备用电机驱动模块，TB6612的市场价约15元/片，比烧毁主控更经济。

3. 直立环(PD)调参详解

直立环采用PD控制，其输出公式为：

输出 = Kp×角度偏差 + Kd×角速度

参数整定步骤：

确定机械中值：测量小车自然静止时的倾角（通常2-3度）
调Kp极性：先给较小正值(如3.0)，测试车轮转向是否正确
找Kp临界值：逐渐增大Kp直到出现大幅低频振荡（记录为Kp_max）
调Kd极性：给Kd较小正值(如0.02)，观察阻尼效果
找Kd临界值：增大Kd直到出现高频抖动（记录为Kd_max）
设置工作参数：Kp=0.6×Kp_max，Kd=0.6×Kd_max

典型参数范围：

Kp：8-15（根据车体质心高度）
Kd：0.04-0.08（与惯性矩相关）

注意：MPU6050的角速度数据需要校准零偏。静止状态下连续采样100次取平均，误差应小于0.5°/s

4. 速度环(PI)调参技巧

速度环的作用是消除直立环的静差，其输出作为直立环的输入补偿。采用PI控制：

输出 = Kp×速度偏差 + Ki×速度偏差积分

调试流程：

极性测试：同时给Kp、Ki赋正值，转动车轮应产生加速反馈
参数比例：通常Ki = Kp/200
找临界值：增大Kp直到小车开始前后往复运动
积分限幅：防止积分饱和导致控制失效

// 速度环PI控制示例
float Velocity_PID(int encoder_L, int encoder_R) {
    static float err_sum = 0;
    float Kp = 30, Ki = 0.15;
    float err = (encoder_L + encoder_R) * 0.5; // 取两轮平均值
    
    err_sum += err;
    err_sum = constrain(err_sum, -12000, 12000); // 积分限幅
    
    return Kp * err + Ki * err_sum;
}

常见问题排查：

小车持续单方向移动：检查编码器接线极性
出现规律性摆动：适当降低Kp或增加Ki
响应迟钝：检查控制周期是否足够（建议5-10ms）

5. 转向环调参与系统耦合

转向环用于消除两轮差异，保持直线运动。采用P控制即可：

float Turn_PID(float yaw) {
    float Kp = 10;
    return Kp * yaw; // yaw为偏航角
}

系统耦合问题：当三个环同时工作时可能出现相互干扰。解决方案：

优先级设置：直立环 > 速度环 > 转向环
输出混合时对转向环做衰减处理（如除以2）
使用不同的控制频率：直立环1kHz，速度环100Hz

6. 关键外设配置要点

CubeMX关键配置：

定时器：
- TIMx：PWM生成，频率10kHz
- TIMy：编码器模式，四倍频
- TIMz：系统定时中断，1kHz
I2C：
- MPU6050使用400kHz高速模式
- OLED使用标准模式(100kHz)
NVIC：
- 系统定时中断优先级高于MPU6050中断
- 编码器中断优先级最低

典型引脚分配：

功能	引脚	备注
电机PWM	PA6-7	TIM3_CH1/2
编码器接口	PB6-7	TIM4_CH1/2
MPU6050 SCL/SDA	PB10/11	I2C2
急停按钮	PC13	外部中断

7. 调试工具链搭建

高效的调试需要构建完整的工具链：

实时监控系统：
- 通过蓝牙模块HC-05发送数据到上位机
- 使用匿名科创地面站等工具可视化曲线

参数快速调整：

// 通过串口指令调整参数
if(收到"KP=15.2"){
    Vertical.Kp = 15.2;
    EEPROM_保存参数();
}

安全机制：
- 添加看门狗定时器
- 关键变量范围检查
- 异常状态自动停机
性能优化技巧：
- 使用DMA传输编码器数据
- 将PID计算放在定时器中断
- 浮点运算启用FPU加速

经过系统化调试后，一台稳定的平衡小车应能达到：

静态平衡维持时间 > 30分钟
抗干扰能力：5°倾斜扰动后1秒内恢复
运动平滑性：速度环稳态误差 < 5 RPM

最后记住，PID调参是"三分理论，七分实践"的过程。保持耐心，每次只调整一个参数，做好调试记录，成功就在下一个参数组合中。