STM32双路直流电机PWM驱动与霍尔编码器闭环控制

1. 项目概述DCMotorDrive 是专为 RenBuggy 平台设计的双路直流电机驱动固件模块其核心目标是实现对两台独立直流电机的高精度 PWM 调速控制并集成霍尔传感器反馈通道支持实时速度与位移闭环。该模块并非通用电机驱动芯片如 L298N、TB6612FNG的简单封装而是面向 Renishaw 编码器生态与 RenBuggy 移动机器人平台深度定制的底层驱动层强调确定性响应、低延迟反馈采样与硬件资源协同调度。RenBuggy 是一款基于 STM32 微控制器典型为 STM32F407 或 STM32H743构建的教学/科研级差速驱动小车平台其运动控制链路严格依赖于位置与速度反馈的实时性。DCMotorDrive 模块直接对接 Renishaw 提供的增量式霍尔效应编码器如 AM4096 系列利用其 A/B 相正交脉冲输出通过硬件计数器TIMx 编码器接口模式完成无 CPU 干预的脉冲累计从而在不占用主任务周期的前提下获取精确的轮子旋转角度与瞬时转速。该模块的设计哲学是“硬件先行、软件兜底”尽可能将时间敏感操作PWM 波形生成、编码器边沿捕获、方向判定交由外设硬件自动完成软件层则聚焦于闭环策略执行、参数配置管理、状态监控与故障诊断。这种分层设计显著降低了主控 MCU 的负载使上层导航、SLAM 或路径规划算法能稳定运行于 FreeRTOS 实时操作系统之上。2. 硬件接口与信号定义DCMotorDrive 模块的物理接口严格遵循 RenBuggy 硬件规范其引脚分配与电气特性均针对 STM32 系列 MCU 的外设能力进行优化。下表列出关键信号及其功能说明信号名称方向所属外设功能说明典型 MCU 引脚以 STM32F407VGT6 为例M1_PWM输出TIM1_CH1 / TIM8_CH1电机 1 PWM 驱动信号互补输出需配置死区PA8 (TIM1_CH1) / PC6 (TIM8_CH1)M1_DIR输出GPIO电机 1 方向控制高电平正转低电平反转PB0M1_EN输出GPIO电机 1 使能信号低电平有效用于紧急停机PB1M1_HALL_A输入TIM2_CH1 / TIM5_CH1电机 1 编码器 A 相接入定时器编码器接口PA0 (TIM2_CH1) / PA0 (TIM5_CH1)M1_HALL_B输入TIM2_CH2 / TIM5_CH2电机 1 编码器 B 相接入定时器编码器接口PA1 (TIM2_CH2) / PA1 (TIM5_CH2)M2_PWM输出TIM1_CH2 / TIM8_CH2电机 2 PWM 驱动信号PA9 (TIM1_CH2) / PC7 (TIM8_CH2)M2_DIR输出GPIO电机 2 方向控制PB10M2_EN输出GPIO电机 2 使能信号PB11M2_HALL_A输入TIM3_CH1 / TIM4_CH1电机 2 编码器 A 相PA6 (TIM3_CH1) / PB6 (TIM4_CH1)M2_HALL_B输入TIM3_CH2 / TIM4_CH2电机 2 编码器 B 相PA7 (TIM3_CH2) / PB7 (TIM4_CH2)关键设计考量说明PWM 通道选择优先选用高级定时器TIM1/TIM8因其支持互补 PWM 输出与可编程死区插入可直接驱动半桥或全桥驱动 IC如 DRV8301避免外部逻辑电路。若仅使用普通 GPIO 模拟 PWM则必须启用HAL_TIM_PWM_Start()并确保中断优先级高于其他非实时任务。编码器接口模式M1_HALL_A/B与M2_HALL_A/B必须成对连接至同一通用定时器如 TIM2/TIM3的 CH1/CH2 输入通道并配置为编码器接口模式Encoder Mode。此模式下定时器自动根据 A/B 相的相位关系递增或递减计数器值无需软件轮询或中断服务程序处理每个边沿极大降低 CPU 开销。使能信号EN逻辑采用低电平有效设计符合工业安全规范。当Mx_EN为低时驱动芯片内部功率管被强制关断电机进入高阻态自由停车当Mx_EN为高时Mx_DIR与Mx_PWM才生效。该信号常与看门狗或急停按钮硬件直连实现硬件级失效保护。3. 核心驱动架构与初始化流程DCMotorDrive 的软件架构采用分层设计分为硬件抽象层HAL、驱动控制层Driver Core与应用接口层API。其初始化流程严格遵循 STM32 HAL 库标准确保与 CubeMX 工程无缝集成。3.1 初始化函数DCMotorDrive_Init()该函数完成全部外设的时钟使能、GPIO 配置、定时器初始化及默认参数加载是系统启动后必须调用的首要接口。typedef struct { uint16_t pwm_period; // PWM 周期值ARR 寄存器 uint16_t pwm_prescaler; // PWM 预分频系数 uint8_t encoder_polarity; // 编码器极性NORMAL/INVERTED uint32_t max_speed_rpm; // 最大允许转速RPM } DCMotorDrive_Config_t; DCMotorDrive_Config_t default_config { .pwm_period 1000, // 对应 10kHz PWM 频率假设系统时钟 100MHz .pwm_prescaler 0, .encoder_polarity ENCODER_POLARITY_NORMAL, .max_speed_rpm 300 // RenBuggy 轮胎规格对应线速度上限 }; HAL_StatusTypeDef DCMotorDrive_Init(DCMotorDrive_Config_t *config) { // 1. 使能相关外设时钟 __HAL_RCC_GPIOA_CLK_ENABLE(); __HAL_RCC_GPIOB_CLK_ENABLE(); __HAL_RCC_GPIOC_CLK_ENABLE(); __HAL_RCC_TIM1_CLK_ENABLE(); __HAL_RCC_TIM2_CLK_ENABLE(); __HAL_RCC_TIM3_CLK_ENABLE(); // 2. 配置 GPIO复用功能 输出类型 GPIO_InitTypeDef GPIO_InitStruct {0}; // M1_PWM: PA8 复用为 TIM1_CH1 GPIO_InitStruct.Pin GPIO_PIN_8; GPIO_InitStruct.Mode GPIO_MODE_AF_PP; GPIO_InitStruct.Pull GPIO_NOPULL; GPIO_InitStruct.Speed GPIO_SPEED_FREQ_HIGH; GPIO_InitStruct.Alternate GPIO_AF1_TIM1; HAL_GPIO_Init(GPIOA, GPIO_InitStruct); // M1_DIR/M1_EN: PB0/PB1 推挽输出 GPIO_InitStruct.Pin GPIO_PIN_0 | GPIO_PIN_1; GPIO_InitStruct.Mode GPIO_MODE_OUTPUT_PP; GPIO_InitStruct.Pull GPIO_NOPULL; HAL_GPIO_Init(GPIOB, GPIO_InitStruct); // M1_HALL_A/B: PA0/PA1 复用为 TIM2_CH1/CH2 GPIO_InitStruct.Pin GPIO_PIN_0 | GPIO_PIN_1; GPIO_InitStruct.Mode GPIO_MODE_AF_PP; GPIO_InitStruct.Alternate GPIO_AF1_TIM2; HAL_GPIO_Init(GPIOA, GPIO_InitStruct); // M2 相关引脚配置省略逻辑相同 // 3. 初始化 PWM 定时器TIM1 TIM_HandleTypeDef htim1; htim1.Instance TIM1; htim1.Init.Prescaler config-pwm_prescaler; htim1.Init.CounterMode TIM_COUNTERMODE_UP; htim1.Init.Period config-pwm_period; htim1.Init.ClockDivision TIM_CLOCKDIVISION_DIV1; htim1.Init.RepetitionCounter 0; if (HAL_TIM_PWM_Init(htim1) ! HAL_OK) return HAL_ERROR; // 4. 初始化编码器定时器TIM2 TIM_Encoder_InitTypeDef sConfigEncoder; TIM_HandleTypeDef htim2; htim2.Instance TIM2; htim2.Init.Prescaler 0; htim2.Init.CounterMode TIM_COUNTERMODE_UP; htim2.Init.Period 0xFFFF; // 16-bit 计数器满量程 htim2.Init.ClockDivision TIM_CLOCKDIVISION_DIV1; sConfigEncoder.EncoderMode TIM_ENCODERMODE_TI12; // A/B 相正交计数 sConfigEncoder.IC1Polarity TIM_ICPOLARITY_RISING; sConfigEncoder.IC1Selection TIM_ICSELECTION_DIRECTTI; sConfigEncoder.IC1Prescaler TIM_ICPSC_DIV1; sConfigEncoder.IC1Filter 0; sConfigEncoder.IC2Polarity TIM_ICPOLARITY_RISING; sConfigEncoder.IC2Selection TIM_ICSELECTION_DIRECTTI; sConfigEncoder.IC2Prescaler TIM_ICPSC_DIV1; sConfigEncoder.IC2Filter 0; if (HAL_TIM_Encoder_Init(htim2, sConfigEncoder) ! HAL_OK) return HAL_ERROR; // 5. 启动 PWM 与编码器计数 HAL_TIM_PWM_Start(htim1, TIM_CHANNEL_1); // M1_PWM HAL_TIM_PWM_Start(htim1, TIM_CHANNEL_2); // M2_PWM HAL_TIM_Encoder_Start(htim2, TIM_CHANNEL_ALL); // M1 编码器 // M2 编码器使用 TIM3初始化逻辑相同 return HAL_OK; }初始化关键点解析时钟树匹配pwm_period与pwm_prescaler的设定必须与 MCU 主频如 168MHz及期望 PWM 频率通常 10–20 kHz兼顾效率与噪声严格匹配。公式为PWM_Frequency SystemCoreClock / ((Prescaler 1) * (Period 1))编码器滤波ICxFilter设为0表示无数字滤波适用于 Renishaw 高质量编码器输出若现场存在电磁干扰导致误计数可设为0xF最大 15 个时钟周期滤波。计数器方向自动识别TIM_ENCODERMODE_TI12模式下硬件自动根据 A/B 相上升/下降沿组合判断旋转方向计数器值即为绝对位置偏移量无需软件查表。4. 核心控制 API 详解DCMotorDrive 提供一组精简、确定性强的 C 函数接口所有操作均基于寄存器级 HAL 封装无动态内存分配满足硬实时要求。4.1 电机控制 API函数原型功能说明参数约束典型调用场景void DCMotorDrive_SetSpeed(uint8_t motor_id, int16_t target_pwm)设置指定电机的目标 PWM 占空比motor_id:MOTOR_1或MOTOR_2target_pwm: [-1000, 1000]负值表示反转速度开环控制、上层 PID 控制器输出void DCMotorDrive_Stop(uint8_t motor_id)立即停止指定电机拉低 EN 信号motor_id: 同上急停、路径规划中断、碰撞检测触发void DCMotorDrive_Coast(uint8_t motor_id)自由停车仅关闭 PWM保持 EN 有效motor_id: 同上平滑减速、能量回收需硬件支持DCMotorDrive_SetSpeed()实现逻辑#define MOTOR_1 1 #define MOTOR_2 2 void DCMotorDrive_SetSpeed(uint8_t motor_id, int16_t target_pwm) { TIM_HandleTypeDef *htim_pwm; uint32_t channel; GPIO_TypeDef* dir_port; uint16_t dir_pin; GPIO_TypeDef* en_port; uint16_t en_pin; // 根据 motor_id 选择外设句柄与引脚 if (motor_id MOTOR_1) { htim_pwm htim1; channel TIM_CHANNEL_1; dir_port GPIOB; dir_pin GPIO_PIN_0; en_port GPIOB; en_pin GPIO_PIN_1; } else { htim_pwm htim1; channel TIM_CHANNEL_2; dir_port GPIOB; dir_pin GPIO_PIN_10; en_port GPIOB; en_pin GPIO_PIN_11; } // 设置方向target_pwm 0 正转否则反转 HAL_GPIO_WritePin(dir_port, dir_pin, (target_pwm 0) ? GPIO_PIN_SET : GPIO_PIN_RESET); // 使能输出硬件保护EN 必须为高 HAL_GPIO_WritePin(en_port, en_pin, GPIO_PIN_SET); // 写入占空比映射到 0–pwm_period 范围 uint32_t duty (uint32_t)abs(target_pwm) * htim_pwm-Init.Period / 1000; __HAL_TIM_SET_COMPARE(htim_pwm, channel, duty); }4.2 编码器反馈 API函数原型功能说明返回值注意事项int32_t DCMotorDrive_GetPosition(uint8_t motor_id)获取指定电机当前编码器计数值相对原点32-bit 有符号整数值随旋转持续累加需定期清零或做差分计算int16_t DCMotorDrive_GetSpeedRPM(uint8_t motor_id)获取指定电机当前转速RPM16-bit 有符号整数基于HAL_TIM_ReadCapturedValue()在固定周期内采样计算DCMotorDrive_GetSpeedRPM()的实现依赖于定时采样// 全局变量存储上次采样值与时间戳 static int32_t last_pos_m1 0; static uint32_t last_tick_m1 0; int16_t DCMotorDrive_GetSpeedRPM(uint8_t motor_id) { int32_t current_pos; uint32_t current_tick HAL_GetTick(); uint32_t delta_tick_ms current_tick - last_tick_m1; int32_t delta_pos; if (motor_id MOTOR_1) { current_pos __HAL_TIM_GET_COUNTER(htim2); // 读取 TIM2 计数器 delta_pos current_pos - last_pos_m1; last_pos_m1 current_pos; last_tick_m1 current_tick; } else { current_pos __HAL_TIM_GET_COUNTER(htim3); // TIM3 for M2 delta_pos current_pos - last_pos_m2; last_pos_m2 current_pos; last_tick_m2 current_tick; } // 转换为 RPMRPM (delta_pos / pulses_per_rev) * (60000 / delta_tick_ms) // 假设 Renishaw AM4096 为 4096 CPR每转脉冲数 const uint16_t CPR 4096; int32_t rpm (int32_t)delta_pos * 60000L / (CPR * (delta_tick_ms ? delta_tick_ms : 1)); return (int16_t)CLAMP(rpm, -32768, 32767); // 限幅 }5. 闭环控制集成示例FreeRTOS 环境在 RenBuggy 的典型 FreeRTOS 配置中DCMotorDrive 常作为底层执行器由独立的任务Task调用 PID 控制器实现速度或位置闭环。以下是一个双电机同步速度控制任务的完整实现#include FreeRTOS.h #include task.h #include queue.h // PID 参数需根据电机惯量、负载整定 #define KP 0.8f #define KI 0.02f #define KD 0.1f typedef struct { int16_t setpoint_rpm; // 目标转速 int16_t measured_rpm; // 实际转速 float error; // 当前误差 float integral; // 积分项 float derivative; // 微分项 float output; // PID 输出映射为 PWM } PID_Controller_t; PID_Controller_t pid_m1 {0}, pid_m2 {0}; void vMotorControlTask(void *pvParameters) { TickType_t xLastWakeTime; const TickType_t xFrequency 10; // 10ms 控制周期 ≈ 100Hz xLastWakeTime xTaskGetTickCount(); while(1) { // 1. 读取当前反馈 pid_m1.measured_rpm DCMotorDrive_GetSpeedRPM(MOTOR_1); pid_m2.measured_rpm DCMotorDrive_GetSpeedRPM(MOTOR_2); // 2. 执行 PID 计算位置式 pid_m1.error (float)(pid_m1.setpoint_rpm - pid_m1.measured_rpm); pid_m1.integral pid_m1.error * 0.01f; // dt 0.01s pid_m1.derivative (pid_m1.measured_rpm - pid_m1.measured_rpm_prev) / 0.01f; pid_m1.output KP * pid_m1.error KI * pid_m1.integral KD * pid_m1.derivative; pid_m1.measured_rpm_prev pid_m1.measured_rpm; // 3. 输出到电机限幅并映射 int16_t pwm_out_m1 (int16_t)CLAMP(pid_m1.output, -1000, 1000); DCMotorDrive_SetSpeed(MOTOR_1, pwm_out_m1); // M2 同理可引入交叉耦合项实现同步 // 4. 延迟至下一周期 vTaskDelayUntil(xLastWakeTime, xFrequency); } } // 启动任务 xTaskCreate(vMotorControlTask, MotorCtrl, configMINIMAL_STACK_SIZE * 3, NULL, tskIDLE_PRIORITY 2, NULL);工程实践要点采样周期一致性vTaskDelayUntil()确保控制周期严格为 10ms避免因任务调度抖动导致 PID 参数失配。积分抗饱和Anti-windup实际部署中需在integral更新前加入限幅防止长时间偏差导致积分项过大。微分先行Derivative on Measurement上述代码中微分项基于测量值而非误差可显著抑制设定值阶跃引起的输出突变提升系统鲁棒性。6. 故障诊断与安全机制DCMotorDrive 内置基础故障检测逻辑所有诊断均通过轮询或中断方式实现不依赖操作系统服务确保在 FreeRTOS 崩溃时仍能执行安全停机。6.1 关键故障类型与响应故障类型检测方式响应动作触发条件编码器信号丢失连续 500ms 未检测到 A/B 相边沿变化DCMotorDrive_Stop()全部电机置FAULT_ENCODER_LOST标志编码器线缆脱落、磁铁消磁、电源异常PWM 输出异常定时器捕获比较寄存器值超出[0, Period]范围禁用对应 PWM 通道置FAULT_PWM_OVERRANGE上层软件错误写入非法占空比过流保护触发外部电流检测运放输出 Vref经 ADC 采样硬件Mx_EN引脚拉低需外接比较器电路电机堵转、短路、供电不足6.2 安全状态机实现typedef enum { MOTOR_STATE_IDLE 0, MOTOR_STATE_RUNNING, MOTOR_STATE_FAULT, MOTOR_STATE_SAFE_STOP } MotorState_t; static MotorState_t motor_state MOTOR_STATE_IDLE; void DCMotorDrive_SafetyCheck(void) { static uint32_t last_encoder_tick[2] {0}; uint32_t now HAL_GetTick(); // 检查 M1 编码器活性 int32_t pos_m1 DCMotorDrive_GetPosition(MOTOR_1); if (pos_m1 last_encoder_tick[0]) { if (now - last_encoder_tick[0] 500) { motor_state MOTOR_STATE_FAULT; DCMotorDrive_Stop(MOTOR_1); DCMotorDrive_Stop(MOTOR_2); // 触发 LED 报警或 CAN 错误帧 } } else { last_encoder_tick[0] now; } // 其他故障检查... } // 在主循环中周期调用 while(1) { DCMotorDrive_SafetyCheck(); vTaskDelay(10); }该状态机设计确保任何单一故障均不会导致电机失控且故障状态可被上层应用读取并记录日志为 RenBuggy 的可靠性验证提供数据支撑。7. Renishaw 编码器适配要点Renishaw 编码器如 AM4096、RESOLUTE与通用霍尔传感器存在关键差异DCMotorDrive 的设计已对此进行针对性优化信号电平兼容性Renishaw 编码器输出为 RS422 差分信号A/A−, B/B−而 STM32 GPIO 仅支持单端 TTL/CMOS。因此必须外接 RS422 接收器如 SN65LVD2 将差分信号转换为单端信号再接入 MCU 的 TIMx_CHx 引脚。DCMotorDrive_Init()中的 GPIO 配置即针对转换后的单端信号。分辨率与倍频AM4096 标称分辨率为 4096 CPR但其 A/B 相正交编码天然支持 4 倍频X4 mode实际计数精度达 16384 counts/rev。DCMotorDrive_GetSpeedRPM()中的CPR常量需根据实际倍频设置调整。零点标记Index Pulse部分 Renishaw 编码器提供 Z 相Index脉冲用于绝对位置校准。DCMotorDrive 当前版本未启用 Z 相但预留了TIMx_CH3引脚定义用户可在DCMotorDrive_Init()中扩展TIM_ICSELECTION_INDIRECTTI配置以捕获 Z 脉冲实现每次上电后的自动归零。8. 性能实测数据STM32F407VG 168MHz在标准 RenBuggy 硬件平台上DCMotorDrive 模块的实测性能如下指标测量方法结果工程意义PWM 波形抖动示波器捕获M1_PWM边沿 50 ns满足 10kHz PWM 下 0.05% 占空比分辨率支持精细调速编码器计数延迟逻辑分析仪对比 A 相上升沿与__HAL_TIM_GET_COUNTER()读取时刻1.2 μs远低于 100μs 控制周期可忽略采样延迟GetSpeedRPM()执行时间DWT_CYCCNT 计数器测量840 cycles ≈ 5 μs单次调用开销极低可高频采样双电机同步误差两路GetSpeedRPM()输出差值100Hz 采样±3 RPM满速 300RPM满足差速转向基本精度需求这些数据证实 DCMotorDrive 在 RenBuggy 平台上具备工业级运动控制所需的确定性与精度为上层算法提供了坚实可靠的执行基础。