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极性正确时，车轮转动方向应与小车倾倒方向一致。一个快速验证方法：

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

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

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

// 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×角速度

参数整定步骤：

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

调试流程：

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

// 速度环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为偏航角
}

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

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

6. 关键外设配置要点

CubeMX关键配置：

1. 定时器：

   • TIMx：PWM生成，频率10kHz
   • TIMy：编码器模式，四倍频
   • TIMz：系统定时中断，1kHz

2. I2C：

   • MPU6050使用400kHz高速模式
   • OLED使用标准模式(100kHz)

3. NVIC：

   • 系统定时中断优先级高于MPU6050中断
   • 编码器中断优先级最低

典型引脚分配：

7. 调试工具链搭建

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

1. 实时监控系统：

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

2. 参数快速调整：

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

3. 安全机制：

   • 添加看门狗定时器
   • 关键变量范围检查
   • 异常状态自动停机

4. 性能优化技巧：

   • 使用DMA传输编码器数据
   • 将PID计算放在定时器中断
   • 浮点运算启用FPU加速

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

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

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