深入浅出PID控制：在STM32自平衡小车中的应用与实践
从零构建STM32自平衡小车：PID控制算法实战指南
两轮自平衡小车是理解现代控制理论的绝佳实验平台。想象一下，当你轻轻推倒这个小家伙，它能像不倒翁一样迅速恢复直立姿态——这种看似简单的平衡背后，隐藏着精妙的PID控制算法与嵌入式系统的完美配合。本文将带你深入PID控制的核心原理，并手把手教你如何在STM32平台上实现一个真正可用的自平衡系统。
1. PID控制：工程师的"魔法公式"
PID控制器由三个关键部分组成：比例（P）、积分（I）和微分（D）。这三个环节协同工作，形成了一个强大的反馈控制系统。
1.1 比例控制：快速响应
比例环节直接处理当前误差（设定值与实际值之差）。在自平衡小车中，误差就是小车当前的倾斜角度与理想垂直位置的偏差。比例系数Kp决定了系统对误差的反应强度：
P_output = Kp × error典型问题：单独使用P控制时，系统会出现稳态误差（小车无法完全直立）和振荡现象。就像试图用手指平衡一根木棍，如果反应太猛，木棍就会来回摆动。
1.2 积分控制：消除残余误差
积分环节累积历史误差，专门解决那些顽固的微小偏差：
I_output = Ki × ∫error dt当你的小车总是差那么一点点不能完全直立时，I项就像一个有耐心的助手，慢慢调整直到误差完全消失。但要注意，过强的积分作用会导致"积分饱和"，使系统反应迟钝。
1.3 微分控制：预见未来
微分环节预测误差的变化趋势，相当于给系统装上了"预见能力"：
D_output = Kd × d(error)/dt它能让小车在开始倾斜时就提前做出反应，而不是等到已经明显歪斜才动作。这大大提高了系统的稳定性，抑制了振荡。
提示：微分项对噪声非常敏感，实际应用中通常需要对原始信号进行滤波处理。
2. STM32硬件平台搭建
2.1 核心组件选型
构建自平衡小车需要以下关键部件：
| 组件 | 型号 | 关键参数 | 功能 |
|---|---|---|---|
| 主控芯片 | STM32F103C8T6 | 72MHz主频，64KB Flash | 运行控制算法 |
| 姿态传感器 | MPU6050 | 三轴加速度计+陀螺仪 | 测量小车倾斜角度 |
| 电机驱动 | L298N | 2A持续电流 | 驱动直流电机 |
| 直流电机 | N20减速电机 | 6V，200RPM | 提供驱动力 |
| 电源管理 | TP4056 | 1A充电电流 | 锂电池充放电管理 |
2.2 传感器数据融合
MPU6050同时提供加速度和角速度数据，但单独使用任一种都有局限：
- 加速度计：低频信号准确，但受振动影响大
- 陀螺仪：高频响应好，但存在漂移问题
通过互补滤波融合两者优势：
// 简单的互补滤波实现 float a = 0.98; // 陀螺仪权重系数 angle = a * (angle + gyro * dt) + (1-a) * accel_angle;更高级的做法是使用卡尔曼滤波，但STM32F103的资源可能吃紧。我在实际项目中发现，精心调参的互补滤波完全能满足基本平衡需求。
3. PID算法在STM32中的实现
3.1 软件架构设计
平衡控制系统主要包含以下任务：
- 传感器数据采集（I2C通信）
- 姿态解算（滤波算法）
- PID计算
- 电机控制（PWM输出）
- 状态显示（OLED）
graph TD A[MPU6050数据] --> B[姿态解算] B --> C[PID计算] C --> D[电机控制] D --> E[电机动作] E --> A3.2 PID核心代码实现
以下是经过实战检验的PID实现代码：
typedef struct { float Kp, Ki, Kd; float Sv; // 设定值 float Pv; // 过程值 float integral; // 积分项 float last_err; // 上次误差 } PID; int PID_Calculate(PID* pid) { float err = pid->Sv - pid->Pv; pid->integral += err; if(pid->integral > 500) pid->integral = 500; // 抗积分饱和 else if(pid->integral < -500) pid->integral = -500; float derivative = err - pid->last_err; pid->last_err = err; return (int)(pid->Kp*err + pid->Ki*pid->integral + pid->Kd*derivative); }3.3 电机控制策略
平衡小车需要同时控制两个电机，保持同步非常重要：
void Motor_Output(int left, int right) { // 限制PWM范围 left = constrain(left, -MAX_PWM, MAX_PWM); right = constrain(right, -MAX_PWM, MAX_PWM); // 设置电机方向和速度 if(left > 0) { HAL_GPIO_WritePin(IN1_GPIO_Port, IN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(IN2_GPIO_Port, IN2_Pin, GPIO_PIN_RESET); } else { HAL_GPIO_WritePin(IN1_GPIO_Port, IN1_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(IN2_GPIO_Port, IN2_Pin, GPIO_PIN_SET); } __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, abs(left)); // 右电机同理 // ... }4. PID参数整定实战技巧
4.1 分步调参法
先调P：将Ki和Kd设为0，逐渐增大Kp直到小车开始小幅振荡
- 表现：小车能快速响应倾斜但会来回摆动
- 目标：找到临界振荡点，然后取该值的50-70%
再调D：加入微分控制抑制振荡
- 表现：摆动幅度减小，稳定性提高
- 注意：过大的Kd会导致系统对噪声敏感
最后调I：消除稳态误差
- 表现：小车能精确保持直立
- 技巧：Ki值通常很小，需要耐心微调
4.2 常见问题排查
| 现象 | 可能原因 | 解决方案 |
|---|---|---|
| 小车剧烈振荡 | Kp过大 | 减小Kp，增加Kd |
| 反应迟钝 | Kp过小 | 适当增大Kp |
| 缓慢倾斜倒地 | 缺乏积分作用 | 适当增加Ki |
| 电机抖动明显 | 微分噪声 | 降低Kd或加强滤波 |
4.3 高级技巧：参数自整定
对于追求极致的开发者，可以尝试简单的自动调参算法：
void AutoTune(PID* pid) { static uint32_t last_time = 0; static float last_angle = 0; float angle_change = fabs(pid->Pv - last_angle); uint32_t time_change = HAL_GetTick() - last_time; if(angle_change > 5.0 && time_change < 50) { // 振荡过快 pid->Kp *= 0.9; pid->Kd *= 1.1; } else if(angle_change < 1.0 && time_change > 200) { // 反应迟钝 pid->Kp *= 1.1; } last_angle = pid->Pv; last_time = HAL_GetTick(); }5. 系统优化与功能扩展
5.1 提高实时性
- 使用硬件I2C加速传感器数据读取
- 将PID计算放在定时器中断中
- 优化浮点运算（STM32F103没有FPU）
// 使用定点数优化 typedef int32_t fixed_point; #define FLOAT_TO_FIXED(x) ((fixed_point)((x) * 1024)) #define FIXED_TO_FLOAT(x) ((float)(x) / 1024)5.2 增加运动控制
基础平衡实现后，可以扩展以下功能：
- 速度控制：增加编码器，实现定速行驶
- 方向控制：通过遥控或自动循迹
- 跌倒保护：检测大角度倾斜时停止电机
// 简单的速度PID实现 int speed_PID(int target_speed, int actual_speed) { static int last_err = 0; static int integral = 0; int err = target_speed - actual_speed; integral += err; integral = constrain(integral, -1000, 1000); int output = speed_Kp*err + speed_Ki*integral + speed_Kd*(err - last_err); last_err = err; return output; }5.3 可视化调试工具
利用OLED显示屏实时显示关键参数：
void Display_Info(float angle, int pwm) { OLED_ShowString(0, 0, "Angle:", 16, 1); OLED_ShowNum(60, 0, (int)(angle*10), 3, 16, 1); // 显示1位小数 OLED_ShowString(0, 2, "PWM:", 16, 1); OLED_ShowNum(60, 2, pwm, 4, 16, 1); OLED_Refresh(); }6. 从实验室到实战：经验分享
调试自平衡小车的过程就像教一个孩子学自行车——需要耐心和技巧。记得我第一次成功让小车保持平衡时，它只坚持了3秒就倒下了。经过两周的调参，最终实现了超过10分钟的稳定站立。
几个实用建议：
- 机械结构要牢固，重心尽量低
- 供电要稳定，电池电压波动会影响电机性能
- 调试时准备一个紧急开关，防止小车失控
- 记录每次参数调整的效果，建立调参日志
PID控制看似简单，但要精通需要大量实践。当你看到自己制作的小车稳稳立在桌面时，那种成就感绝对值得所有的努力。现在，是时候拿起你的STM32开发板，开始这段奇妙的控制之旅了！