别再硬调PID了！用STM32和MPU6050手把手教你调平衡小车（附完整代码避坑点）

从零构建平衡小车：STM32与MPU6050的PID控制实战指南

平衡小车的魅力在于它完美融合了物理原理与嵌入式控制的精髓。许多初学者在第一次接触这个项目时，往往会被PID参数调节这一环节难住——面对不断抖动、失控的小车，只能盲目尝试各种参数组合。本文将带你从底层原理出发，构建一套系统化的调试方法论，让你不再靠运气调参。

1. 平衡小车控制系统的核心架构

平衡小车的控制系统本质上是一个多环反馈系统，主要由三个控制环构成：

1. 直立环（角度环）：负责维持小车的直立状态
2. 速度环：确保小车在平衡时不发生位移
3. 转向环：控制小车的行进方向

这三个环并非独立工作，而是相互耦合、相互影响的。理解它们之间的关系是成功调试的关键。

1.1 硬件选型与搭建要点

在开始软件调试前，合理的硬件配置是基础。以下是经过验证的硬件组合方案：

组件	推荐型号	关键参数	注意事项
主控芯片	STM32F103C8T6	72MHz主频，20KB RAM	确保有足够定时器资源
姿态传感器	MPU6050	±2000°/s陀螺仪量程	需做传感器校准
电机驱动	TB6612FNG	1.2A持续电流	注意散热设计
编码器	光电编码器	500线/转	确保AB相接线正确
电源管理	18650电池组	7.4V输出	需加装稳压模块

硬件搭建时最容易出错的几个地方：

• MPU6050安装位置应尽量靠近小车重心
• 电机轴与轮毂的连接需牢固无松动
• 编码器信号线需做适当屏蔽以防干扰
• 整车重心高度应控制在合理范围内

1.2 软件框架设计

一个健壮的平衡小车软件架构应包含以下模块：

// 典型平衡小车软件架构 void main() { hardware_init(); // 硬件初始化 sensor_calibration(); // 传感器校准 pid_init(); // PID参数初始化 while(1) { read_sensors(); // 读取传感器数据 data_filter(); // 数据滤波处理 balance_control(); // 平衡控制计算 motor_output(); // 电机输出 debug_monitor(); // 调试信息输出 } }

关键的中断服务程序配置：

// 定时器中断服务程序 void TIM3_IRQHandler(void) { if(TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET) { TIM_ClearITPendingBit(TIM3, TIM_IT_Update); control_cycle++; // 控制周期计数 if(control_cycle % BALANCE_CYCLE == 0) { balance_flag = 1; // 触发平衡控制 } if(control_cycle % SPEED_CYCLE == 0) { speed_flag = 1; // 触发速度控制 } } }

2. 传感器数据处理与滤波技术

原始传感器数据往往包含噪声，直接使用会导致控制效果不佳。MPU6050输出的数据需要经过精心处理才能用于控制计算。

2.1 MPU6050数据校准

在使用MPU6050前，必须进行校准：

1. 将传感器水平静止放置
2. 采集1000组陀螺仪和加速度计数据
3. 计算各轴零偏值
4. 将零偏值存储在Flash中供后续使用

校准代码示例：

void mpu6050_calibration(void) { int32_t gx_sum = 0, gy_sum = 0, gz_sum = 0; int32_t ax_sum = 0, ay_sum = 0, az_sum = 0; for(int i=0; i<1000; i++) { mpu6050_read_data(); gx_sum += gx_raw; gy_sum += gy_raw; gz_sum += gz_raw; ax_sum += ax_raw; ay_sum += ay_raw; az_sum += az_raw; delay_ms(5); } gyro_offset.x = gx_sum / 1000; gyro_offset.y = gy_sum / 1000; gyro_offset.z = gz_sum / 1000; accel_offset.x = ax_sum / 1000; accel_offset.y = ay_sum / 1000; accel_offset.z = (az_sum / 1000) - 16384; // 1g对应的值 }

2.2 姿态解算算法选择

常见的姿态解算方法有：

• 互补滤波：计算量小，适合资源有限的MCU
• 卡尔曼滤波：精度高但实现复杂
• Mahony滤波：折中方案，效果较好

推荐使用互补滤波作为入门方案：

float complementary_filter(float acc_angle, float gyro_rate, float dt) { static float angle = 0; float alpha = 0.98; // 滤波系数 angle = alpha * (angle + gyro_rate * dt) + (1-alpha) * acc_angle; return angle; }

2.3 编码器数据处理

电机编码器数据用于速度环控制，处理时需注意：

• 使用硬件计数器捕获编码器脉冲
• 定期读取计数值并清零
• 转换为实际转速

void encoder_read(int16_t *left, int16_t *right) { *left = TIM2->CNT; // 左编码器计数器值 *right = TIM4->CNT; // 右编码器计数器值 TIM2->CNT = 0; // 清零计数器 TIM4->CNT = 0; }

3. PID控制原理与参数整定

PID控制是平衡小车的核心，理解其工作原理比盲目调参更重要。

3.1 PID控制基本公式

离散化PID公式：

输出 = Kp×误差 + Ki×积分(误差) + Kd×微分(误差)

在代码中的实现：

typedef struct { float kp; float ki; float kd; float integral; float prev_error; } PID_Controller; float pid_compute(PID_Controller *pid, float error, float dt) { float derivative = (error - pid->prev_error) / dt; pid->integral += error * dt; // 积分限幅 if(pid->integral > INTEGRAL_LIMIT) pid->integral = INTEGRAL_LIMIT; else if(pid->integral < -INTEGRAL_LIMIT) pid->integral = -INTEGRAL_LIMIT; float output = pid->kp * error + pid->ki * pid->integral + pid->kd * derivative; pid->prev_error = error; return output; }

3.2 直立环（角度环）调试

直立环调试步骤：

1. 确定机械中值：

   • 小车前倾至即将倾倒，记录角度θ1
   • 小车后倾至即将倾倒，记录角度θ2
   • 中值 = (θ1 + θ2)/2

2. P参数调试：

   • 清零其他参数，从小开始增大Kp
   • 观察小车响应，找到能维持平衡但不剧烈振荡的值

3. D参数调试：

   • 保持Kp不变，从零开始增加Kd
   • 目标是抑制振荡，提高稳定性

直立环常见问题及解决方案：

现象	可能原因	解决方法
小车向一侧倾倒	机械中值不准确	重新校准中值
低频大幅振荡	Kp过大或Kd不足	适当减小Kp或增加Kd
高频小幅振荡	Kd过大	减小Kd值
响应迟钝	Kp过小	适当增加Kp

3.3 速度环调试

速度环一般采用PI控制，调试要点：

1. 极性测试：

   • 关闭直立环，手动转动车轮
   • 正确极性：车轮会继续沿转动方向加速

2. P参数调试：

   • 从小开始增加Kp，观察小车位移控制效果
   • 理想状态：小车能在小范围内保持位置

3. I参数调试：

   • 按照经验，Ki ≈ Kp/200
   • 根据实际效果微调

速度环调试时常见错误：

• 编码器接线错误导致速度检测失效
• 积分项未做限幅导致积分饱和
• 速度环输出未与直立环输出合理叠加

3.4 转向环调试

转向环相对简单，主要控制小车行进方向：

1. 极性测试：

   • 绕Z轴旋转小车
   • 正确极性：车轮转向应与旋转方向相反

2. P参数调试：

   • 从小开始增加Kp，直到能维持直线行驶
   • 过大会导致高频抖动

4. 系统集成与性能优化

当各控制环单独调试完成后，需要将它们整合并进行整体优化。

4.1 控制环耦合分析

三个控制环之间存在复杂的耦合关系：

1. 直立环与速度环：

   • 速度环输出会干扰直立环工作
   • 需合理设置两环的控制周期

2. 速度环与转向环：

   • 转向时两轮速度差会影响速度环计算
   • 需在速度计算时考虑转向因素

3. 控制周期设置：

   • 直立环：2-5ms（最高优先级）
   • 速度环：10-20ms
   • 转向环：20-50ms

4.2 抗干扰能力提升

提高系统鲁棒性的几种方法：

• 软件滤波：对传感器数据进行滑动平均或低通滤波
• 输出限幅：限制电机PWM输出的最大最小值
• 死区处理：对小误差不响应，避免电机高频切换
• 故障检测：监测系统状态，异常时安全停机

// 带死区和限幅的电机输出函数 void motor_output(int16_t pwm_left, int16_t pwm_right) { // 死区处理 if(abs(pwm_left) < DEAD_ZONE) pwm_left = 0; if(abs(pwm_right) < DEAD_ZONE) pwm_right = 0; // 限幅处理 pwm_left = constrain(pwm_left, -PWM_MAX, PWM_MAX); pwm_right = constrain(pwm_right, -PWM_MAX, PWM_MAX); // 实际输出 if(pwm_left > 0) { MOTOR_LEFT_FORWARD(pwm_left); } else { MOTOR_LEFT_BACKWARD(-pwm_left); } if(pwm_right > 0) { MOTOR_RIGHT_FORWARD(pwm_right); } else { MOTOR_RIGHT_BACKWARD(-pwm_right); } }

4.3 调试工具与技巧

有效的调试工具可以事半功倍：

1. 串口示波器：

   • 实时绘制关键变量曲线
   • 分析系统动态响应

2. 蓝牙调试APP：

   • 手机端实时监控和参数调整
   • 无需连接电脑即可调试

3. 参数存储：

   • 将优化后的参数存储在Flash中
   • 下次上电自动加载

// 参数存储与加载示例 void save_parameters(void) { uint32_t addr = PARAM_START_ADDR; FLASH_Unlock(); FLASH_ErasePage(PARAM_START_ADDR); FLASH_ProgramWord(addr, *(uint32_t*)&balance_kp); addr +=4; FLASH_ProgramWord(addr, *(uint32_t*)&balance_kd); addr +=4; FLASH_ProgramWord(addr, *(uint32_t*)&speed_kp); addr +=4; // 其他参数... FLASH_Lock(); } void load_parameters(void) { uint32_t addr = PARAM_START_ADDR; balance_kp = *(float*)addr; addr +=4; balance_kd = *(float*)addr; addr +=4; speed_kp = *(float*)addr; addr +=4; // 其他参数... }

5. 常见问题排查指南

即使按照规范调试，仍可能遇到各种问题。以下是典型问题及解决方案。

5.1 硬件相关问题排查

问题1：小车完全无反应

检查步骤：

1. 电源电压是否正常
2. 主控芯片是否正常运行（LED闪烁）
3. 电机驱动使能信号是否正确
4. 各连接线是否接触良好

问题2：电机转动不正常

检查步骤：

1. 编码器接线是否正确（A、B相）
2. 电机驱动输入逻辑是否正确
3. PWM信号是否正常输出
4. 电机本身是否损坏

5.2 软件相关问题排查

问题1：小车剧烈振荡

可能原因：

1. PID参数设置不当
2. 传感器数据异常
3. 控制周期不稳定

解决方案：

1. 逐步减小P参数
2. 检查传感器数据是否合理
3. 确保定时器中断配置正确

问题2：小车缓慢倾斜

可能原因：

1. 机械中值不准确
2. I参数设置不当
3. 传感器零漂严重

解决方案：

1. 重新校准机械中值
2. 适当增加I参数
3. 重新校准传感器

5.3 性能优化检查清单

当基本功能实现后，可通过以下步骤进一步提升性能：

1. [ ] 传感器数据滤波优化
2. [ ] 控制环时序重新规划
3. [ ] PID参数精细调整
4. [ ] 电机响应特性测试
5. [ ] 系统抗干扰测试

6. 进阶技巧与扩展应用

当基础平衡功能稳定后，可以考虑进一步扩展小车功能。

6.1 无线遥控功能实现

通过蓝牙或2.4G模块实现无线控制：

1. 蓝牙模块（HC-05/06）：

   • 与手机APP通信
   • 实现参数调整和状态监控

2. NRF24L01：

   • 2.4G无线通信
   • 适合遥控器控制

// 蓝牙通信处理示例 void bluetooth_handler(void) { if(USART_GetFlagStatus(USART1, USART_FLAG_RXNE)) { char cmd = USART_ReceiveData(USART1); switch(cmd) { case 'A': balance_kp += 1.0; break; case 'B': balance_kp -= 1.0; break; // 其他命令... } } }

6.2 路径规划与自主导航

结合测距传感器实现简单导航：

1. 超声波模块：测距避障
2. 红外传感器：巡线功能
3. 视觉传感器：高级导航

6.3 竞赛性能优化

针对竞赛场景的优化方向：

1. 轻量化设计：减少整车重量
2. 动力系统升级：更高性能电机
3. 控制算法改进：自适应PID、模糊控制等
4. 能量管理优化：低功耗设计

平衡小车的调试是一门实践性极强的技术，需要耐心和系统化的方法。在调试过程中，保持记录每个参数变化对应的现象，这将帮助你快速积累经验。当小车最终稳稳立住的那一刻，所有的努力都会变得值得。