STM32智能车PID调速与传感器融合实战

1. 项目概述

这个基于STM32F103RCT6的智能车项目，是我去年带队参加大学生智能车竞赛时的实战作品。整个系统最核心的创新点在于将光电编码器与直流电机PID调速系统完美结合，配合多种传感器模块实现了高精度的运动控制。下面我就从硬件设计到软件实现，完整复盘这个项目的技术细节。

2. 硬件架构设计

2.1 核心控制器选型

选择STM32F103RCT6作为主控芯片主要基于三点考虑：

1. 72MHz主频足够处理多传感器数据融合
2. 自带3个USART和2个CAN接口满足通信需求
3. 多达5个定时器可同时用于编码器接口和PWM生成

实际调试中发现，RCT6的512KB Flash完全够用，但64KB RAM在运行卡尔曼滤波时略显紧张，后续可以考虑升级到STM32F407系列

2.2 电机驱动方案

采用TB6612FNG双H桥驱动芯片，相比传统的L298N具有明显优势：

• 效率提升：典型导通电阻仅0.4Ω（L298N为3Ω）
• 体积缩小：SSOP24封装节省60%PCB面积
• 保护完善：内置过热关断和低压检测

电机参数：

• 工作电压：12V DC
• 空载转速：200rpm
• 编码器分辨率：13线/转（经过4倍频后52脉冲/转）

2.3 传感器布局

关键传感器配置：

1. 光电编码器：安装在电机输出轴，用于速度闭环
2. MPU6050：车体中心位置，减少振动干扰
3. OLED显示屏：朝向操作者倾斜15°安装
4. CAN总线：采用120Ω终端电阻匹配阻抗

3. 软件实现细节

3.1 编码器速度测量

使用TIM定时器的编码器接口模式，配置要点：

c复制void Encoder_Config(TIM_TypeDef* TIMx){
    TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
    TIM_TimeBaseStructure.TIM_Prescaler = 0;
    TIM_TimeBaseStructure.TIM_Period = 65535; // 16位最大值
    TIM_TimeBaseStructure.TIM_ClockDivision = 0;
    TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
    TIM_TimeBaseInit(TIMx, &TIM_TimeBaseStructure);
    
    TIM_ICInitTypeDef TIM_ICInitStructure;
    TIM_ICInitStructure.TIM_Channel = TIM_Channel_1;
    TIM_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising;
    TIM_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;
    TIM_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1;
    TIM_ICInitStructure.TIM_ICFilter = 0x0F; // 重要！抑制噪声
    TIM_ICInit(TIMx, &TIM_ICInitStructure);
    
    TIM_EncoderInterfaceConfig(TIMx, TIM_EncoderMode_TI12, 
                              TIM_ICPolarity_Rising, 
                              TIM_ICPolarity_Rising);
    TIM_Cmd(TIMx, ENABLE);
}

速度计算算法：

c复制float Get_Speed(uint32_t dt_ms){
    static int32_t last_count = 0;
    int32_t current_count = TIM_GetCounter(TIMx);
    int32_t delta = current_count - last_count;
    last_count = current_count;
    
    // 转每秒脉冲数：delta/(dt_ms/1000) = delta*1000/dt_ms
    float pulse_per_sec = (delta * 1000.0f) / dt_ms;
    // 转换为cm/s： (脉冲数/52)*轮周长
    return (pulse_per_sec/52.0f) * 21.0f; // 轮周长21cm
}

3.2 PID调速系统实现

改进型增量式PID实现：

c复制typedef struct{
    float Target;     // 目标值
    float Kp,Ki,Kd;   // PID参数
    float Error_Last; // 上次偏差
    float Integral;   // 积分项
    float Output;     // 输出值
    uint16_t MaxOut;  // 输出限幅
    float Alpha;      // 低通滤波系数(0~1)
}PID_TypeDef;

void PID_Calc(PID_TypeDef* pid){
    float error = pid->Target - Get_Speed();
    
    // 积分分离：偏差大时不积分
    if(fabs(error) < 200) {
        pid->Integral += error;
        pid->Integral = fmaxf(fminf(pid->Integral, pid->MaxOut/pid->Ki), -pid->MaxOut/pid->Ki);
    }
    
    // 微分项低通滤波
    static float last_dout = 0;
    float dout = (error - pid->Error_Last) * pid->Kd;
    dout = pid->Alpha * dout + (1-pid->Alpha) * last_dout;
    last_dout = dout;
    
    pid->Output = pid->Kp*error + pid->Ki*pid->Integral + dout;
    pid->Output = fmaxf(fminf(pid->Output, pid->MaxOut), -pid->MaxOut);
    pid->Error_Last = error;
}

参数整定经验：

1. 先调Kp至系统开始振荡，然后取50%作为初始值
2. 再调Ki至消除静差，但不超过Kp的1/10
3. 最后加Kd抑制超调，典型值为Kp的1/4
4. 低通滤波系数Alpha建议0.3-0.5

3.3 多传感器数据融合

MPU6050数据读取优化：

c复制void MPU6050_Read_Raw(int16_t* acc, int16_t* gyro){
    uint8_t buf[14]; // 包含温度数据
    I2C_Read_Reg(MPU6050_ADDR, ACCEL_XOUT_H, buf, 14);
    
    // 数据拼接注意字节序（大端模式）
    acc[0] = (int16_t)((buf[0]<<8) | buf[1]);
    acc[1] = (int16_t)((buf[2]<<8) | buf[3]);
    acc[2] = (int16_t)((buf[4]<<8) | buf[5]);
    gyro[0] = (int16_t)((buf[8]<<8) | buf[9]);
    gyro[1] = (int16_t)((buf[10]<<8) | buf[11]);
    gyro[2] = (int16_t)((buf[12]<<8) | buf[13]);
    
    // 校准补偿
    acc[0] -= acc_bias[0];
    gyro[0] -= gyro_bias[0];
    // ...其他轴类似
}

互补滤波实现：

c复制float Complementary_Filter(float acc_angle, float gyro_rate, float dt){
    static float angle = 0;
    const float alpha = 0.98; // 陀螺仪权重
    
    // 加速度计角度计算（注意限制分母不为零）
    float acc_angle_rad = atan2f(acc_y, sqrtf(acc_x*acc_x + acc_z*acc_z));
    
    // 互补滤波核心公式
    angle = alpha * (angle + gyro_rate * dt) 
          + (1-alpha) * acc_angle_rad;
    
    return angle * 180.0f / M_PI; // 转为角度
}

4. 通信系统设计

4.1 CAN总线实现

CAN初始化关键配置：

c复制CAN_InitTypeDef CAN_InitStructure;
CAN_InitStructure.CAN_TTCM = DISABLE;
CAN_InitStructure.CAN_ABOM = ENABLE; // 自动离线恢复
CAN_InitStructure.CAN_AWUM = ENABLE; // 自动唤醒
CAN_InitStructure.CAN_NART = DISABLE; // 重传使能
CAN_InitStructure.CAN_RFLM = DISABLE;
CAN_InitStructure.CAN_TXFP = DISABLE;
CAN_InitStructure.CAN_Mode = CAN_Mode_Normal;
CAN_InitStructure.CAN_SJW = CAN_SJW_1tq;
CAN_InitStructure.CAN_BS1 = CAN_BS1_9tq;
CAN_InitStructure.CAN_BS2 = CAN_BS2_4tq;
CAN_InitStructure.CAN_Prescaler = 6; // 1MHz速率
CAN_Init(CAN1, &CAN_InitStructure);

4.2 数据协议设计

自定义通信协议帧格式：

5. 电源与抗干扰设计

5.1 电源架构

采用三级电源设计：

1. 第一级：12V输入，LM2596降压至5V（电机驱动电源）
2. 第二级：5V转3.3V（数字电路电源）
3. 第三级：3.3V经LC滤波（模拟传感器电源）

关键器件选型：

• 磁珠：BLM21PG221SN1（220Ω@100MHz）
• 滤波电容：10μF钽电容 + 0.1μF陶瓷电容组合
• 稳压芯片：AMS1117-3.3（最大1A输出）

5.2 PCB布局技巧

1. 电机驱动电路与MCU分区布局
2. 模拟地与数字地单点连接
3. 关键信号线走内层（如I2C、编码器信号）
4. 电源入口处放置TVS二极管（SMBJ12CA）

6. 调试经验与问题排查

6.1 常见问题速查表

6.2 性能优化技巧

1. 定时器中断优先级设置：

   • 编码器计数：最高优先级（Preemption=0）
   • PID计算：中优先级（Preemption=1）
   • 通信处理：最低优先级（Preemption=2）

2. 内存优化：

   c复制#pragma pack(push, 1) // 单字节对齐
   typedef struct{
       uint8_t header;
       float data[2];
       uint16_t crc;
   }Packet_TypeDef;
   #pragma pack(pop)
   

3. 实时性保障：

   • 使用DMA传输传感器数据
   • 关键代码放在RAM执行（通过__attribute__((section(".ramfunc")))）

这个项目从硬件设计到软件调试前后历时3个月，最深刻的体会是：在嵌入式系统中，硬件可靠性是基础，软件算法是灵魂，而抗干扰设计往往是决定成败的关键。后续计划增加激光雷达避障功能，正在研究将STM32与ESP32通过SPI通信的方案。