从零搭建STM32平衡小车：手把手教你避开新手十大雷区

第一次尝试做平衡小车的时候，我盯着桌上那堆零件发呆了半小时——MPU6050的引脚该怎么接？电机为什么总是一边转一边不转？PID参数调了一整天，小车还是像醉汉一样东倒西歪。如果你也经历过这种绝望，这篇文章就是为你准备的。我们将用最通俗的语言，把平衡小车拆解成可执行的步骤，每个环节都标注了新手最容易翻车的地方。

1. 硬件组装：别让接线错误毁掉你的第一天

1.1 核心部件清单与选购避坑

• 主控选择：STM32F103C8T6（蓝板）性价比最高，但要注意市面上有CH32仿制版（价格低但性能差）
• 传感器陷阱：MPU6050有DMP版本（内置姿态解算）和普通版，新手建议选带DMP的GY-521模块
• 电机驱动：TB6612比L298N发热小，但注意驱动电压要与电机匹配（常见6V/12V）
• 电源方案：18650电池组最经济，但必须配带均衡保护的充放电模块

提示：购买电机时务必确认是否带编码器，无编码器的小车后期速度控制会非常困难

1.2 电路连接中的死亡陷阱

这是我在实验室见过最多的错误接线方式：

c复制// 正确的MPU6050初始化代码（I2C版本）
void MPU6050_Init(void) {
    I2C_WriteByte(MPU6050_ADDR, PWR_MGMT_1, 0x00); // 解除休眠
    I2C_WriteByte(MPU6050_ADDR, SMPLRT_DIV, 0x07); // 采样率1kHz
    I2C_WriteByte(MPU6050_ADDR, CONFIG, 0x06);     // 低通滤波
    I2C_WriteByte(MPU6050_ADDR, GYRO_CONFIG, 0x18); // ±2000°/s量程
    I2C_WriteByte(MPU6050_ADDR, ACCEL_CONFIG, 0x18);// ±16g量程
}

2. 姿态解算：让传感器说"人话"

2.1 原始数据校准的必备操作

上电后必须先执行校准流程：

1. 将小车水平静止放置
2. 采集200次陀螺仪读数取平均作为零偏
3. 旋转90度验证各轴方向是否正确

python复制# 简易校准算法示例（实际需在STM32实现）
def calibrate_gyro():
    offsets = [0, 0, 0]
    for _ in range(200):
        data = read_gyro_raw()
        offsets = [offsets[i] + data[i] for i in range(3)]
    return [x/200 for x in offsets]

2.2 互补滤波的实战调参

经典互补滤波公式看似简单，但参数选择有讲究：

code复制当前角度 = 0.98×(上一角度 + 陀螺仪读数×dt) + 0.02×加速度计角度

• 系数选择：新手可从0.98开始尝试，根据现象调整：
  • 小车反应迟钝 → 增大陀螺仪权重（0.98→0.99）
  • 小车高频抖动 → 增大加速度计权重（0.98→0.95）
• dt稳定性：必须使用定时器中断确保固定采样周期（推荐1-5ms）

注意：不要盲目追求卡尔曼滤波，新手往往调不好状态方程反而更糟

3. PID控制：从玄学到科学的调参指南

3.1 三环控制的启动顺序

必须严格按照以下顺序调试，否则会陷入无限死循环：

1. 角度环单独调试：先让小车能勉强站立

   • 初始参数建议：Kp=40, Ki=0, Kd=0.8
   • 现象观察：轻推小车应有恢复趋势但会振荡

2. 加入速度环：抑制角度环的长期漂移

   • 初始参数建议：Kp=10, Ki=0.5, Kd=0
   • 测试方法：给定期望速度看能否匀速移动

3. 位置环（可选）：实现定点停车

   • 需要编码器提供精确位移反馈

3.2 参数整定的实战技巧

这是我总结的"土方法"调试流程：

1. 将Ki、Kd设为0，逐渐增大Kp直到小车开始高频抖动
2. 取当前Kp值的50%作为基准
3. 增加Kd直到抖动消失（通常为Kp的1/20~1/50）
4. 最后微调Ki消除静态误差（通常为Kp的1/100）

c复制// 增量式PID实现（抗积分饱和）
typedef struct {
    float Kp, Ki, Kd;
    float last_error, prev_error;
} PID;

float PID_Update(PID* pid, float target, float feedback) {
    float error = target - feedback;
    float delta = pid->Kp*(error - pid->last_error) 
                + pid->Ki*error 
                + pid->Kd*(error - 2*pid->last_error + pid->prev_error);
    pid->prev_error = pid->last_error;
    pid->last_error = error;
    return delta;
}

4. 机械结构与调试技巧

4.1 重心设计的黄金法则

• 电池位置：应该安装在车轮轴线上方1-2cm处
• 重心高度：整体重心高度不超过轮径的1/3
• 减震方案：用泡棉胶带固定电路板避免振动干扰

4.2 常见故障排查清单

当小车出现以下症状时，可以这样诊断：

5. 进阶优化：让你的小车更稳定

5.1 软件滤波的三种武器

1. 滑动平均滤波：适用于编码器速度计算

   c复制#define FILTER_SIZE 5
   float speed_filter[FILTER_SIZE];
   
   float moving_average(float new_val) {
       static int index = 0;
       speed_filter[index] = new_val;
       index = (index + 1) % FILTER_SIZE;
       
       float sum = 0;
       for(int i=0; i<FILTER_SIZE; i++) {
           sum += speed_filter[i];
       }
       return sum / FILTER_SIZE;
   }
   

2. 低通滤波：消除高频噪声

   c复制float low_pass(float new_val, float old_val, float alpha) {
       return alpha * new_val + (1 - alpha) * old_val; 
   }
   

3. 中值滤波：应对突发干扰

5.2 蓝牙调试的终极方案

推荐使用USART+HMI工具的方案：

1. 在STM32端封装关键变量为结构体

   c复制typedef struct {
       float angle;
       float speed;
       PID_params pid;
   } DebugData;
   

2. 使用匿名上位机或自己编写QT界面
3. 实时绘制曲线观察参数变化

最后分享一个血泪教训：永远在电机电源线上加磁环，我的第一块STM32就是因为电机反电动势烧毁了串口芯片。现在我的小车已经能顶着书本稳定站立了——这可能是最有成就感的毕业设计。