当前位置：首页 > news >正文

别再只让电机傻转了！给JGB37-520加上TB6612和STM32编码器模式，实现精准速度与位置控制

news 2026/5/28 22:58:08

从脉冲到闭环：基于STM32的JGB37-520电机精准控制实战

在创客项目和工业自动化中，直流电机控制一直是个既基础又关键的环节。但大多数开发者止步于简单的"通电-转动"阶段，就像给一匹野马套上缰绳却从不驯服——电机要么全速狂奔，要么完全静止，中间状态完全失控。这种开环控制方式在需要精确运动控制的场景下显得力不从心，比如3D打印机喷头定位、机器人关节控制或自动化生产线传送带调速。

1. 硬件架构解析：构建控制系统的物理基础

1.1 JGB37-520电机与霍尔编码器特性

JGB37-520是一款典型的减速直流电机，其核心参数决定了整个控制系统的设计边界：

额定电压：12V DC 空载转速：300 RPM（减速后） 减速比：30:1 编码器类型：正交霍尔编码器 每转脉冲数(PPR)：11（单相）→ 660（减速后整转）

霍尔编码器通过检测磁场变化产生脉冲，相比光电编码器具有更好的抗污染能力。其A、B两相输出存在90°相位差，这种正交特性不仅用于计数，还能通过相位关系判断转向。在30:1减速比下，电机输出轴每转实际产生660个脉冲（11PPR×30×2），这为高分辨率位置检测提供了可能。

1.2 TB6612驱动模块的实战配置

TB6612作为双通道H桥驱动芯片，其优势在于低导通电阻（0.5Ω）和高效率PWM驱动。典型接线配置如下：

引脚	连接目标	功能说明
VM	12V电源	电机驱动电源
VCC	3.3V/5V	逻辑电平电源
GND	共地	参考地电位
AO1/AO2	电机两极	电流输出端
PWMA	TIMx_CHx	PWM速度控制
AIN1/AIN2	GPIO	方向控制

方向控制真值表：

// 典型控制逻辑 AIN1 AIN2 电机状态 HIGH LOW 正转 LOW HIGH 反转 LOW LOW 刹车 HIGH HIGH 刹车

注意：实际项目中建议在VM端增加100μF以上的去耦电容，并在靠近芯片处放置0.1μF陶瓷电容，可显著降低PWM噪声对控制信号的干扰。

2. STM32编码器接口深度配置

2.1 定时器编码器模式初始化

STM32的TIMx定时器内置专用编码器接口，可自动处理正交信号。以下为CubeMX配置要点：

选择支持编码器模式的定时器（TIM2-TIM5）
编码器模式选择"Encoder Mode TI1 and TI2"
设置合适的计数范围（ARR值）
配置输入滤波器（通常4-8个时钟周期）

对应的寄存器级初始化代码：

void Encoder_Config(void) { TIM_Encoder_InitTypeDef encoder = {0}; TIM_MasterConfigTypeDef master = {0}; htim2.Instance = TIM2; htim2.Init.Prescaler = 0; htim2.Init.CounterMode = TIM_COUNTERMODE_UP; htim2.Init.Period = 0xFFFF; // 16位最大值 htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; encoder.EncoderMode = TIM_ENCODERMODE_TI12; encoder.IC1Polarity = TIM_ICPOLARITY_RISING; encoder.IC1Selection = TIM_ICSELECTION_DIRECTTI; encoder.IC1Prescaler = TIM_ICPSC_DIV1; encoder.IC1Filter = 6; // 相同配置应用于IC2... HAL_TIM_Encoder_Init(&htim2, &encoder); HAL_TIM_Encoder_Start(&htim2, TIM_CHANNEL_ALL); }

2.2 速度计算与方向判定实战

速度计算需要考虑采样周期和编码器分辨率。假设采用100ms采样周期：

int16_t Get_Speed_RPM(void) { static int32_t last_count = 0; int32_t current_count = TIM2->CNT; int32_t delta = current_count - last_count; last_count = current_count; // 脉冲转RPM公式：(Δcounts × 60) / (PPR × sample_time_sec) float rpm = (delta * 60.0f) / (660.0f * 0.1f); return (int16_t)rpm; }

方向判定可直接读取定时器的DIR位：

bool Is_Clockwise(void) { return (TIM2->CR1 & TIM_CR1_DIR) == 0; }

3. PID控制算法实现与调参

3.1 离散PID的工程实现

采用位置式PID算法，避免积分饱和问题：

typedef struct { float Kp, Ki, Kd; float integral; float prev_error; uint32_t last_time; } PID_Controller; float PID_Update(PID_Controller* pid, float setpoint, float measurement) { uint32_t now = HAL_GetTick(); float dt = (now - pid->last_time) / 1000.0f; pid->last_time = now; float error = setpoint - measurement; pid->integral += error * dt; float derivative = (error - pid->prev_error) / dt; pid->prev_error = error; return pid->Kp * error + pid->Ki * pid->integral + pid->Kd * derivative; }

3.2 参数整定经验法则

采用试凑法调参时的典型流程：

初始化阶段：
- 将Ki和Kd设为0
- 逐步增加Kp直到系统开始振荡
- 取振荡时Kp值的50%作为初始P参数
积分调节：
- 逐步增加Ki直到静差消除
- 观察是否出现超调或振荡
微分调节：
- 增加Kd抑制超调
- 注意噪声放大问题

实用技巧：在调试初期限制输出幅度（如PWM占空比不超过70%），避免电机过冲损坏机械结构。

4. 系统集成与性能优化

4.1 实时监控与数据可视化

利用STM32的USB CDC或UART输出调试数据，配合Python可视化：

# 简易串口绘图示例 import serial import matplotlib.pyplot as plt ser = serial.Serial('COM3', 115200) plt.ion() fig, ax = plt.subplots() x, y = [], [] while True: data = ser.readline().decode().strip() if data: x.append(len(x)) y.append(float(data)) ax.clear() ax.plot(x, y) plt.pause(0.01)