别只盯着OpenMV！用TB6612电机驱动给STM32小车调个“跟车”速度环PID
基于TB6612与STM32的智能小车速度环PID控制实战
在智能小车开发领域，运动控制性能直接影响着跟踪的平滑度和响应速度。许多开发者习惯性地将注意力集中在OpenMV等视觉处理模块上，却忽视了底层电机驱动与控制算法的重要性。本文将深入探讨如何利用STM32的定时器PWM输出，结合TB6612电机驱动芯片，为小车的左右轮分别实现独立的速度闭环控制，打造更精准的"跟车"系统。
1. 电机驱动选型：TB6612 vs L298N
在智能小车设计中，电机驱动芯片的选择往往决定了整个系统的控制精度和响应速度。传统方案中，L298N因其价格低廉而被广泛使用，但在PID调速场景下，TB6612展现出明显优势。
TB6612的核心优势：
- 更低的导通电阻：仅0.5Ω（H桥上下合计），相比L298N的3Ω大幅降低，意味着更小的发热量和更高的效率
- 更高的PWM频率支持：可达100kHz，而L298N通常建议在5-10kHz以下，这使得TB6612能实现更精细的速度控制
- 集成电流检测：内置电路可检测电机电流，为过流保护提供硬件支持
- 双路独立控制：单芯片可同时驱动两个电机，且相互干扰小
// TB6612典型接线示例（STM32） #define PWMA TIM1->CCR1 // 电机A PWM #define AIN1 PC0 // 电机A方向1 #define AIN2 PC1 // 电机A方向2 #define PWMB TIM1->CCR2 // 电机B PWM #define BIN1 PC2 // 电机B方向1 #define BIN2 PC3 // 电机B方向2实际测试数据显示，在相同供电条件下：
| 参数 | TB6612 | L298N |
|---|---|---|
| 空载响应时间 | 15ms | 35ms |
| 10% PWM抖动 | ±2% | ±8% |
| 满载温升 | 12℃ | 38℃ |
| 最大效率 | 92% | 78% |
2. STM32定时器PWM配置要点
STM32的定时器模块为电机控制提供了硬件级的PWM生成能力。要实现精准的双轮独立控制，需要合理配置定时器资源。
关键配置步骤：
时钟树配置：
- 确保定时器时钟源足够（通常使用72MHz）
- 计算PWM频率：
PWM频率 = 定时器时钟/(ARR+1)/(PSC+1)
定时器初始化：
void TIM1_PWM_Init(u16 arr, u16 psc) { GPIO_InitTypeDef GPIO_InitStructure; TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_OCInitTypeDef TIM_OCInitStructure; RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); // 配置PA8(通道1), PA9(通道2)为复用推挽输出 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_8 | GPIO_Pin_9; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOA, &GPIO_InitStructure); TIM_TimeBaseStructure.TIM_Period = arr; TIM_TimeBaseStructure.TIM_Prescaler = psc; TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM1, &TIM_TimeBaseStructure); TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; TIM_OCInitStructure.TIM_Pulse = 0; TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; TIM_OC1Init(TIM1, &TIM_OCInitStructure); TIM_OC2Init(TIM1, &TIM_OCInitStructure); TIM_CtrlPWMOutputs(TIM1, ENABLE); TIM_OC1PreloadConfig(TIM1, TIM_OCPreload_Enable); TIM_OC2PreloadConfig(TIM1, TIM_OCPreload_Enable); TIM_ARRPreloadConfig(TIM1, ENABLE); TIM_Cmd(TIM1, ENABLE); }- PWM映射关系：
TIM_SetCompare1(TIM1, duty)控制左轮PWMTIM_SetCompare2(TIM1, duty)控制右轮PWM- 占空比计算：
实际占空比 = CCRx/(ARR+1)
提示：建议将PWM频率设置在10-20kHz之间，既能避免可闻噪声，又能保证控制响应速度。同时注意配置死区时间防止H桥直通。
3. 速度环PID实现与参数整定
速度闭环是保证小车平稳跟踪的基础。我们采用增量式PID算法，相比位置式更适合电机控制场景。
PID算法实现：
typedef struct { float Target; // 目标速度 float Current; // 当前速度 float Err; // 当前误差 float Err_Last; // 上次误差 float Kp, Ki, Kd; // PID参数 float Integral; // 积分项 float Output; // 输出值 } PID_TypeDef; void PID_Calc(PID_TypeDef *pid) { pid->Err = pid->Target - pid->Current; // 抗积分饱和处理 if(fabs(pid->Output) < PWM_MAX) { pid->Integral += pid->Err; } pid->Output = pid->Kp * pid->Err + pid->Ki * pid->Integral + pid->Kd * (pid->Err - pid->Err_Last); pid->Err_Last = pid->Err; // 输出限幅 pid->Output = constrain(pid->Output, -PWM_MAX, PWM_MAX); }参数整定方法：
先调P再调D最后I原则：
- 将Ki和Kd设为0，逐渐增大Kp直到系统出现等幅振荡
- 记录此时的临界增益Ku和振荡周期Tu
- 根据Ziegler-Nichols公式：
- Kp = 0.6*Ku
- Ki = 2*Kp/Tu
- Kd = Kp*Tu/8
现场调试技巧：
- 使用上位机实时监控速度曲线
- 先测试阶跃响应，观察超调量和稳定时间
- 最后加入负载扰动，测试抗干扰能力
典型参数参考值：
| 电机类型 | Kp | Ki | Kd | 采样周期 |
|---|---|---|---|---|
| 直流减速电机 | 8.5 | 0.05 | 0.12 | 10ms |
| 步进电机 | 15.0 | 0.02 | 0.25 | 5ms |
| 空心杯电机 | 3.2 | 0.1 | 0.05 | 20ms |
4. 动态速度调节与跟车逻辑实现
智能跟车的核心是根据距离动态调整速度，实现"远则快，近则慢"的平滑跟踪效果。我们从OpenMV获取距离信息(Tz_num)后，需要合理映射到电机基础占空比(led0pwmval)。
距离-速度映射策略：
#define MIN_DISTANCE 20.0f // 最小安全距离(cm) #define MAX_DISTANCE 100.0f // 最大跟踪距离(cm) #define MIN_PWM 300 // 对应最小速度 #define MAX_PWM 700 // 对应最大速度 float map_distance_to_pwm(float distance) { if(distance < MIN_DISTANCE) return 0; if(distance > MAX_DISTANCE) return MAX_PWM; // 非线性映射：近距离变化敏感，远距离变化平缓 float ratio = (distance - MIN_DISTANCE)/(MAX_DISTANCE - MIN_DISTANCE); return MIN_PWM + (MAX_PWM - MIN_PWM) * pow(ratio, 0.7); }完整跟车控制流程：
- 从OpenMV获取目标距离Tz_num和横向偏移Tx_num
- 计算基础PWM值：
base_pwm = map_distance_to_pwm(Tz_num) - 计算转向补偿：
steer_comp = constrain(Tx_num * STEER_GAIN, -MAX_COMP, MAX_COMP) - 分配左右轮PWM：
left_pwm = base_pwm + steer_comp; right_pwm = base_pwm - steer_comp; // 限幅处理 left_pwm = constrain(left_pwm, MIN_PWM, MAX_PWM); right_pwm = constrain(right_pwm, MIN_PWM, MAX_PWM); - 更新PWM输出：
TIM_SetCompare1(TIM1, (u16)left_pwm); // 左轮 TIM_SetCompare2(TIM1, (u16)right_pwm); // 右轮
异常处理机制：
- 当丢失目标时，逐渐减速停止而非急刹
- 设置最小安全距离，防止碰撞
- 加入软件滤波，避免距离数据突变导致控制抖动
5. 系统优化与性能提升技巧
在实际部署中，以下几个优化点能显著提升系统性能：
硬件层面优化：
- 为TB6612添加散热片，确保长时间工作稳定性
- 电机电源与逻辑电源分离，减少干扰
- 编码器信号线使用双绞线，并做好屏蔽
软件层面优化：
- 速度采样优化：
// 使用定时器输入捕获测量编码器脉冲间隔 void TIM2_IRQHandler(void) { if(TIM_GetITStatus(TIM2, TIM_IT_CC1) != RESET) { static u32 last_cnt = 0; u32 curr_cnt = TIM_GetCapture1(TIM2); speed_rpm = 60000000 / (curr_cnt - last_cnt) / ENCODER_PPR; last_cnt = curr_cnt; TIM_ClearITPendingBit(TIM2, TIM_IT_CC1); } }- 抗干扰处理：
- 对速度采样值进行滑动平均滤波
- 对PWM输出加入渐变处理，避免突变
- 关键变量使用volatile声明，防止编译器优化
- 参数自适应：
// 根据速度范围自动调整PID参数 void adapt_pid_params(PID_TypeDef *pid, float speed) { if(speed < LOW_SPEED_THRESHOLD) { pid->Kp = KP_SLOW; pid->Ki = KI_SLOW; pid->Kd = KD_SLOW; } else { pid->Kp = KP_NORMAL; pid->Ki = KI_NORMAL; pid->Kd = KD_NORMAL; } }调试工具链推荐：
- ST-Link：用于程序下载和调试
- VOFA+：可视化数据监测工具
- 匿名四轴上位机：专为电机调试设计的监控软件
- 逻辑分析仪：用于检查PWM波形和编码器信号