STM32 HAL库实战：用TB6612FNG模块让GB37-520电机实现前进、后退、转向的多种运动模式

STM32 HAL库实战：用TB6612FNG模块实现GB37-520电机的智能运动控制

在机器人底盘和智能小车开发中，精确控制电机运动是核心挑战之一。许多开发者虽然能够实现电机的基本转动，但当需要组合多种运动模式时，往往会陷入复杂的逻辑设计和参数调试困境。本文将带您深入探索如何利用STM32 HAL库和TB6612FNG驱动模块，为GB37-520电机构建一套完整的运动控制系统。

1. 硬件架构与运动控制原理

1.1 TB6612FNG驱动模块的关键特性

TB6612FNG作为一款双通道电机驱动芯片，其性能直接影响运动控制效果：

• 双路独立控制：可同时驱动两个直流电机，每路提供1.2A连续电流（3.2A峰值）
• 低导通电阻：上桥臂0.4Ω，下桥臂0.3Ω，效率高达95%
• 宽电压范围：VM供电2.5-13.5V，适合多种电机规格
• PWM频率支持：最高可达100kHz，远超普通电机响应频率

// 典型引脚连接配置 #define AIN1_PIN GPIO_PIN_13 #define AIN1_PORT GPIOB #define AIN2_PIN GPIO_PIN_12 #define AIN2_PORT GPIOB #define PWMA_TIM htim1 #define PWMA_CHANNEL TIM_CHANNEL_4

1.2 差速转向的运动学基础

两轮差速驱动的运动控制遵循以下基本公式：

左轮速度 Vl = V - (ω × L)/2 右轮速度 Vr = V + (ω × L)/2

其中：

• V：车身前进速度
• ω：转向角速度
• L：两轮间距

通过调整左右轮速比，可实现多种运动模式：

2. 运动控制系统的软件架构

2.1 电机驱动层实现

在motor.h中定义运动控制接口：

typedef enum { MOTOR_FORWARD = 0, MOTOR_BACKWARD = 1, MOTOR_STOP = 2, MOTOR_BRAKE = 3 } MotorDirection; void Motor_Init(void); void Motor_SetPWM(TIM_HandleTypeDef* htim, uint32_t channel, int16_t pwm); void Motor_Control(MotorDirection dir, int16_t leftPWM, int16_t rightPWM);

对应的motor.c实现核心控制逻辑：

void Motor_Control(MotorDirection dir, int16_t leftPWM, int16_t rightPWM) { switch(dir) { case MOTOR_FORWARD: HAL_GPIO_WritePin(AIN1_GPIO_Port, AIN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(AIN2_GPIO_Port, AIN2_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(BIN1_GPIO_Port, BIN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(BIN2_GPIO_Port, BIN2_Pin, GPIO_PIN_RESET); break; // 其他方向控制类似 } __HAL_TIM_SET_COMPARE(&PWMA_TIM, PWMA_CHANNEL, abs(leftPWM)); __HAL_TIM_SET_COMPARE(&PWMB_TIM, PWMB_CHANNEL, abs(rightPWM)); }

2.2 运动模式状态机设计

建立运动指令集状态机，实现模式切换：

typedef enum { MODE_IDLE, MODE_FORWARD, MODE_BACKWARD, MODE_TURN_LEFT, MODE_TURN_RIGHT, MODE_SPIN_CW, MODE_SPIN_CCW } MotionMode; typedef struct { MotionMode currentMode; int16_t leftSpeed; int16_t rightSpeed; uint32_t duration; } MotionState; void Motion_Update(MotionState* state) { switch(state->currentMode) { case MODE_FORWARD: Motor_Control(MOTOR_FORWARD, state->leftSpeed, state->rightSpeed); break; case MODE_SPIN_CW: Motor_Control(MOTOR_FORWARD, state->leftSpeed, -state->rightSpeed); break; // 其他模式处理 } }

3. 高级运动控制技巧

3.1 运动轨迹平滑处理

突然的速度变化会导致机械冲击，采用加速度限制：

#define MAX_ACCEL 500 // PWM变化率/秒 void Smooth_SpeedTransition(int16_t* current, int16_t target, uint32_t dt) { int16_t step = MAX_ACCEL * dt / 1000; if(*current < target) { *current = (*current + step) > target ? target : (*current + step); } else { *current = (*current - step) < target ? target : (*current - step); } }

3.2 基于定时器的运动序列

利用硬件定时器实现精确时间控制：

void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef* htim) { if(htim == &htim2) { // 10ms定时器 static uint32_t counter = 0; counter++; if(counter == 100) { // 1秒后执行转弯 motionState.currentMode = MODE_TURN_RIGHT; motionState.leftSpeed = 3000; motionState.rightSpeed = 1000; } } }

4. 实战：智能小车运动控制系统

4.1 完整运动指令集实现

typedef struct { MotionMode mode; int16_t leftPWM; int16_t rightPWM; uint32_t duration; } MotionCommand; const MotionCommand commandSequence[] = { {MODE_FORWARD, 4000, 4000, 2000}, // 直行2秒 {MODE_TURN_RIGHT, 3000, 1000, 1500}, // 右转1.5秒 {MODE_BACKWARD, 2000, 2000, 1000}, // 后退1秒 {MODE_SPIN_CCW, 2500, 2500, 1800} // 原地逆时针转1.8秒 }; void Execute_CommandSequence(void) { for(uint8_t i = 0; i < sizeof(commandSequence)/sizeof(MotionCommand); i++) { motionState.currentMode = commandSequence[i].mode; motionState.leftSpeed = commandSequence[i].leftPWM; motionState.rightSpeed = commandSequence[i].rightPWM; Motion_Update(&motionState); HAL_Delay(commandSequence[i].duration); } }

4.2 运动参数调试技巧

1. 基础参数校准：

   • 空载时测量电机最大转速对应的PWM值
   • 记录不同PWM值下的实际移动距离
   • 建立PWM-速度换算表

2. 转向对称性调整：

   // 转向补偿系数 float turnCompensation = 1.05f; // 右转通常需要稍大的PWM rightPWM = (int16_t)(rightPWM * turnCompensation);

3. 电池电压补偿：

   // 读取当前电池电压（假设通过ADC） float batteryFactor = 7.4f / currentVoltage; // 标称7.4V pwmValue = (int16_t)(pwmValue * batteryFactor);

5. 性能优化与异常处理

5.1 实时监控与保护机制

void Motor_SafetyCheck(void) { // 温度监测 if(HAL_GPIO_ReadPin(TEMP_GPIO_Port, TEMP_Pin) == GPIO_PIN_SET) { Motor_Control(MOTOR_STOP, 0, 0); Error_Handler(); } // 电流检测 if(ADC_GetCurrent() > MAX_CURRENT) { Motor_Control(MOTOR_BRAKE, 0, 0); } }

5.2 运动控制性能指标

通过以下参数评估系统性能：

• 响应时间：从指令发出到电机达到目标速度的延迟
• 速度一致性：直线运动时的左右轮速差
• 转向精度：90°转向命令的实际转向角度误差
• 重复定位精度：多次执行相同指令的位置偏差

在项目开发中，我们通过实验测得GB37-520电机配合TB6612FNG的典型性能：

6. 扩展应用：多模式运动控制

6.1 遥控指令解析实现

void Parse_RemoteCommand(uint8_t* data) { switch(data[0]) { case 0x01: // 摇杆模式 motionState.leftSpeed = (int16_t)((data[1] << 8) | data[2]); motionState.rightSpeed = (int16_t)((data[3] << 8) | data[4]); break; case 0x02: // 预设动作 Execute_PresetAction(data[1]); break; } }

6.2 自动循迹扩展接口

void LineFollowing_Update(int16_t positionError) { // PID计算转向量 float steer = PID_Calculate(&linePID, positionError); // 差速控制 motionState.leftSpeed = BASE_SPEED * (1 - steer); motionState.rightSpeed = BASE_SPEED * (1 + steer); Motion_Update(&motionState); }

在实际智能小车项目中，这套运动控制系统表现出色。特别是在复杂路径跟踪时，通过将转向角度映射为左右轮速差，实现了平滑的轨迹跟踪效果。测试中发现，当PWM频率设置在18-20kHz时，电机运行最为平稳，且TB6612FNG发热量最小。