从智能小车到机械臂：基于STM32和TB6612的电机控制库设计与封装实战-开发者社区

从智能小车到机械臂：基于STM32和TB6612的电机控制库设计与封装实战

在嵌入式开发领域，电机控制是机器人、自动化设备等项目的核心基础。无论是智能小车的运动控制，还是机械臂的精准定位，亦或是云台的稳定跟踪，都离不开对电机的高效驱动。本文将带你深入探讨如何基于STM32和TB6612设计一个可复用的电机控制库，实现从底层驱动到上层应用的完整封装。

1. 电机控制库的设计理念

1.1 为什么需要电机控制库

在嵌入式项目中，电机控制代码往往会被反复使用。传统做法是每次项目都重新编写驱动代码，这不仅效率低下，还容易引入错误。一个设计良好的电机控制库可以带来以下优势：

代码复用性：一次编写，多处使用
维护便捷：统一修改，全局生效
接口标准化：降低使用门槛
功能扩展：易于添加新特性

1.2 面向对象的设计思想

虽然C语言不是面向对象的语言，但我们可以通过结构体和函数指针模拟面向对象的特性：

typedef struct { GPIO_TypeDef* dir_port; uint16_t dir_pin1; uint16_t dir_pin2; TIM_HandleTypeDef* pwm_tim; uint32_t pwm_channel; int32_t current_speed; } Motor_HandleTypeDef;

这种封装方式将电机相关的数据和操作绑定在一起，提高了代码的内聚性。

2. TB6612驱动模块深度解析

2.1 硬件特性与连接方式

TB6612是一款双H桥电机驱动芯片，其主要特性包括：

参数	规格
工作电压	2.7-13.5V
持续电流	1.2A/通道
峰值电流	3.2A/通道
PWM频率	最高100kHz

典型连接方式如下：

// STM32与TB6612连接示例 #define MOTOR_A_PWM TIM2->CCR1 // PA0 #define MOTOR_A_IN1 GPIO_PIN_1 // PA1 #define MOTOR_A_IN2 GPIO_PIN_2 // PA2 #define MOTOR_B_PWM TIM2->CCR2 // PA3 #define MOTOR_B_IN1 GPIO_PIN_4 // PA4 #define MOTOR_B_IN2 GPIO_PIN_5 // PA5 #define STBY_PIN GPIO_PIN_6 // PA6

2.2 硬件设计注意事项

电源设计：电机电源与逻辑电源需分开供电
散热考虑：持续大电流工作需加散热片
保护电路：建议增加反接保护和滤波电容

提示：在PCB布局时，尽量缩短电机驱动芯片与STM32之间的走线距离，减少干扰。

3. 电机控制库的实现

3.1 库文件结构设计

一个完整的电机控制库应包含以下文件：

motor_lib/ ├── inc/ │ ├── motor.h // 主要头文件 │ └── motor_conf.h // 配置头文件 └── src/ ├── motor.c // 核心实现 └── motor_hal.c // 硬件抽象层

3.2 核心API设计

// 电机初始化 HAL_StatusTypeDef MOTOR_Init(Motor_HandleTypeDef *hmotor); // 设置电机速度 void MOTOR_SetSpeed(Motor_HandleTypeDef *hmotor, int16_t speed); // 电机刹车 void MOTOR_Brake(Motor_HandleTypeDef *hmotor); // 软启动控制 void MOTOR_SoftStart(Motor_HandleTypeDef *hmotor, int16_t target_speed, uint16_t duration_ms);

3.3 防止头文件重复包含

在头文件中使用标准的防护宏：

#ifndef __MOTOR_H #define __MOTOR_H // 头文件内容... #endif /* __MOTOR_H */

4. 高级功能实现

4.1 PID速度环控制

实现一个简单的PID控制器：

typedef struct { float Kp; float Ki; float Kd; float integral; float prev_error; } PID_HandleTypeDef; float PID_Update(PID_HandleTypeDef *hpid, float setpoint, float actual, float dt) { float error = setpoint - actual; hpid->integral += error * dt; float derivative = (error - hpid->prev_error) / dt; hpid->prev_error = error; return hpid->Kp * error + hpid->Ki * hpid->integral + hpid->Kd * derivative; }

4.2 多电机同步控制

对于需要协调控制的场景，如差速转向的小车：

void MOTOR_SyncControl(Motor_HandleTypeDef *hmotor1, Motor_HandleTypeDef *hmotor2, int16_t speed, int16_t turn) { int16_t left_speed = speed - turn; int16_t right_speed = speed + turn; MOTOR_SetSpeed(hmotor1, left_speed); MOTOR_SetSpeed(hmotor2, right_speed); }

5. 实际应用案例

5.1 智能小车应用

void Car_MoveForward(Motor_HandleTypeDef *hleft, Motor_HandleTypeDef *hright, int16_t speed) { MOTOR_SetSpeed(hleft, speed); MOTOR_SetSpeed(hright, speed); } void Car_Turn(Motor_HandleTypeDef *hleft, Motor_HandleTypeDef *hright, int16_t speed, int16_t turn) { MOTOR_SetSpeed(hleft, speed - turn); MOTOR_SetSpeed(hright, speed + turn); }

5.2 机械臂关节控制

对于机械臂应用，需要考虑位置控制：

void Arm_JointMove(Motor_HandleTypeDef *hmotor, int16_t target_angle) { // 读取当前角度（假设有编码器反馈） int16_t current_angle = ENCODER_Read(hmotor->encoder); // 计算PID输出 float output = PID_Update(&hmotor->pid, target_angle, current_angle, 0.01); // 设置电机速度 MOTOR_SetSpeed(hmotor, (int16_t)output); }