告别玄学调参：用Cubemx HAL库+MPU6050 DMP，给你的STM32平衡小车一个‘出厂设置’
从零构建STM32平衡小车：HAL库与DMP的黄金组合
平衡小车一直是嵌入式开发者和电子竞赛选手的热门项目，它不仅考验硬件搭建能力，更是对软件算法和传感器融合技术的全面检验。传统方法中，开发者往往需要从零开始处理MPU6050的原始数据，实现复杂的传感器融合算法，这个过程既耗时又容易出错。本文将带你使用STM32CubeMX和HAL库，结合MPU6050的DMP（数字运动处理器）功能，快速搭建一个稳定的平衡平台。
1. 硬件架构设计要点
一个典型的平衡小车硬件系统包含以下几个核心模块：
- 主控单元：STM32F103C8T6（蓝色药丸板）或STM32F407系列
- 运动传感器：MPU6050（集成三轴加速度计和三轴陀螺仪）
- 电机驱动：TB6612或L298N
- 反馈系统：带编码器的直流电机
- 电源管理：3.7V锂电池+升压模块或18650电池组
关键硬件连接表：
| 模块 | 接口类型 | STM32引脚 | 备注 |
|---|---|---|---|
| MPU6050 | I2C | PB6(SCL), PB7(SDA) | 需接上拉电阻 |
| TB6612 PWM | TIM | PA8(CH1), PA9(CH2) | 电机控制信号 |
| 编码器A | TIM | PA0, PA1 | 正交编码模式 |
| 编码器B | TIM | PA6, PA7 | 正交编码模式 |
提示：MPU6050的AD0引脚接地表示I2C地址为0x68，接VCC则为0x69。实际布线时，传感器应尽量靠近小车重心位置安装。
2. CubeMX工程配置详解
2.1 时钟与基本外设
启动CubeMX后，首先配置系统时钟：
在"Pinout & Configuration"选项卡中设置RCC
- HSE选择"Crystal/Ceramic Resonator"
- 在Clock Configuration页面配置系统时钟为72MHz（F103）或168MHz（F407）
配置调试接口
- SYS→Debug选择"Serial Wire"
- 这将启用SWD下载接口，保留PA13(SWDIO)和PA14(SWCLK)
2.2 I2C与MPU6050通信
MPU6050通过I2C接口通信，配置步骤如下：
// CubeMX I2C配置参数示例 hi2c1.Instance = I2C1; hi2c1.Init.ClockSpeed = 400000; // 400kHz标准模式 hi2c1.Init.DutyCycle = I2C_DUTYCYCLE_2; hi2c1.Init.OwnAddress1 = 0; hi2c1.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT; hi2c1.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE; hi2c1.Init.OwnAddress2 = 0; hi2c1.Init.GeneralCallMode = I2C_GENERALCALL_DISABLE; hi2c1.Init.NoStretchMode = I2C_NOSTRETCH_DISABLE;注意：I2C总线上必须连接4.7kΩ上拉电阻，否则通信可能失败。若使用开发板，通常已集成这些电阻。
2.3 定时器配置策略
平衡小车需要三个关键定时器：
平衡控制定时器：TIM1，10ms中断周期
- 用于MPU数据读取和PID计算
- 预分频器(Prescaler)设为72-1，计数器周期(Period)设为10000-1
编码器接口定时器：TIM3和TIM4
- 设置为Encoder Mode
- 滤波器(Filter)值建议设为6
PWM生成定时器：TIM2
- 通道1和2设为PWM Generation CHx
- 20kHz PWM频率（Prescaler=72-1, Period=100-1）
3. DMP库移植与优化
3.1 DMP初始化流程
MPU6050的DMP（数字运动处理器）可以自动完成传感器数据融合，输出稳定的欧拉角。移植官方DMP库时需要关注以下关键函数：
uint8_t mpu_dmp_init(void) { // 1. 初始化I2C和MPU6050 if(mpu_init()!=0) return 1; // 2. 设置传感器量程 mpu_set_gyro_fsr(2000); // ±2000°/s mpu_set_accel_fsr(2); // ±2g // 3. 加载DMP固件 if(dmp_load_motion_driver_firmware()!=0) return 2; // 4. 设置DMP输出速率 dmp_set_fifo_rate(100); // 100Hz // 5. 启用DMP功能 dmp_enable_feature(DMP_FEATURE_6X_LP_QUAT | DMP_FEATURE_SEND_RAW_ACCEL); // 6. 启动DMP dmp_enable_fifo_notify(); mpu_set_dmp_state(1); return 0; }3.2 数据读取与校准
在定时器中断中读取DMP处理后的数据：
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if(htim->Instance == TIM1) { float pitch, roll, yaw; short gyro[3], accel[3]; // 获取欧拉角 if(mpu_dmp_get_data(&pitch, &roll, &yaw)==0) { // 获取原始传感器数据 MPU_Get_Gyroscope(&gyro[0], &gyro[1], &gyro[2]); MPU_Get_Accelerometer(&accel[0], &accel[1], &accel[2]); // 获取编码器值 int16_t enc_left = getEncoderleft(); int16_t enc_right = getEncoderright(); // 执行平衡控制 balance_control(pitch, gyro[0], enc_left, enc_right); } } }校准技巧：
- 上电时将小车静止放置在水平面上2秒
- 调用
mpu_run_self_test()进行自检 - 通过
mpu_set_gyro_bias()和mpu_set_accel_bias()设置零偏
4. 控制算法实现
4.1 串级PID结构设计
平衡小车通常采用三级PID控制：
直立环：控制小车倾角
float balance_pid(float target, float angle, float gyro) { static float last_angle; float err = angle - target; float d_err = (err - last_angle) * 100; // 100Hz采样 last_angle = err; return BALANCE_KP * err + BALANCE_KD * gyro; }速度环：维持小车位置
float speed_pid(int encoder_left, int encoder_right) { static float integral; float speed = (encoder_left + encoder_right) * 0.5f; integral += speed; integral = constrain(integral, -20000, 20000); return SPEED_KP * speed + SPEED_KI * integral; }转向环：控制行进方向
float turn_pid(float gyro_z) { return TURN_KP * gyro_z; }
4.2 参数整定经验
PID参数调试顺序：
- 先调直立环的KP，让小车能勉强站住但大幅摆动
- 加入KD抑制摆动，达到基本平衡
- 加入速度环KI，防止小车缓慢移动
- 最后调整转向环参数
典型参数范围参考：
| 控制环 | KP | KI | KD |
|---|---|---|---|
| 直立环 | 200-500 | 0 | 0.8-2.0 |
| 速度环 | -0.005~-0.02 | -0.0001~-0.001 | 0 |
| 转向环 | -100~-200 | 0 | 0.5-1.5 |
注意：实际参数与硬件特性强相关，上述值仅供参考。调试时建议每次只修改一个参数，变化幅度控制在±20%。
5. 系统集成与调试技巧
5.1 软件架构设计
推荐采用模块化编程结构：
balance_car/ ├── Drivers/ # HAL库文件 ├── Inc/ │ ├── mpu6050.h # MPU6050驱动 │ ├── pid.h # PID算法 │ └── motor.h # 电机控制 ├── Src/ │ ├── main.c # 主循环 │ ├── stm32f1xx_it.c # 中断处理 │ └── control.c # 核心控制逻辑 └── Middlewares/ # DMP库文件5.2 常见问题排查
问题1：DMP初始化失败
- 检查I2C通信是否正常（用逻辑分析仪抓波形）
- 确认MPU6050的VCC电压稳定（3.3V±10%）
- 尝试降低I2C时钟频率到100kHz
问题2：小车剧烈振荡
- 降低直立环KP，增加KD
- 检查MPU6050安装是否牢固
- 确认编码器方向与电机转向匹配
问题3：向一侧缓慢移动
- 调整MPU6050的安装水平度
- 增加速度环KI值
- 检查电机PWM信号对称性
5.3 进阶优化方向
动态参数调整：根据倾角大小自动调整PID参数
if(fabs(pitch) > 15.0f) { // 大角度时使用更激进参数 balance_kp = 500; balance_kd = 2.5; } else { // 小角度时使用精细参数 balance_kp = 300; balance_kd = 1.2; }运动轨迹规划：实现定距移动或指定角度转向
无线监控：通过蓝牙或NRF24L01传输实时数据到上位机
在实际项目中，我发现最影响稳定性的因素往往是机械结构而非算法。一个低重心的结构设计能让平衡控制事半功倍。建议先用3D打印制作可调式车架，通过配重块找到最佳重心位置后再固定电池和电路板位置。