简介面向医疗电子与嵌入式开发者STM32智能注射控速系统方案涵盖电机控制、脉搏监测、液晶显示和嵌入式软件设计。系统以STM32为核心通过PWM精准调节注射速率利用PPG/ECG传感器实时采集脉搏信号异常时自动调整或停止注射对医疗输液场景有直接参考价值。包内共225个文件压缩包约5.6MB以C/H源码、Keil工程文件、编译生成的axf/hex/map文件为主并含配置脚本和说明文档便于查看完整工程架构、跟踪代码逻辑及烧录验证覆盖从开发到编译的各个环节。已有116人学习下载适合正在开展STM32电机控制、注射泵或生物信号处理项目的研究者。借助源码与工程可快速理解ADC采集、信号滤波、PWM驱动等完整链路也可作为课程设计或医疗设备原型开发的参考范本。1. STM32监控与智能注射控速系统的技术边界病房里的注射泵、实验室里的微量注射泵、产线上的定量注液设备工作方式都是一样的步进电机通过丝杆推动注射器活塞以设定的 ml/h 速度把液体推出去。见过最多的故障不是电机不转而是电机在转、编码器没动液体没走系统还在傻傻地报“正常”。这个标题里的STM32监控指的不是监控电压和温度而是监控“电机轴到底有没有按指令走”stm32电机和motorcontrolstm32说的是步进电机驱动这一层最终落点是智能注射控速系统的流量闭环和安全保护。这套方案比较适合三类人做医疗器械嵌入式开发、做毕业设计选择 STM32 电机控制课题、改造现有注液设备但不想引入伺服系统的人。2. 注射控速原理步进电机选型与流量换算2.1 为什么注射泵选步进电机而不是直流或伺服电机注射泵的速度范围通常在 0.1 ml/h 到 1000 ml/h 之间换算成电机转速大部分时间电机轴每分钟只转几圈到几十圈。这种低速场景下直流有刷电机要配减速箱加编码器才能定位伺服电机的成本又偏高步进电机却有先天优势低速扭矩大、开环就能保持位置、控制接口只需要 STEP/DIR/ENA 三根线。常见的做法是用 A4988 或 DRV8825 做驱动芯片对噪声敏感的场合换 TMC2209靠硬件细分就能把低频振动压下去。驱动层的接线固定一套模式MCU 的 GPIO 接 DIR 控制方向PWM 或定时器翻转接 STEP 控制步进脉冲ENA 控制使能。注意一点A4988 和 DRV8825 的 ENA 电平逻辑不一样A4988 低电平使能DRV8825 默认低电平使能但有些模块做了反向上电先测一组空转脉冲确认方向再装到注射器上。选型时要把电机额定电流和驱动芯片的电流设置电阻算清楚。注射泵负载一般是丝杆加注射器活塞阻力不大但堵管时电流会明显上升。我一般会把驱动电流调到电机额定电流的 80%既保证正常运行扭矩又给堵转检测留出电流余量。2.2 细分、步距角与速度-流量换算步进电机常见步距角是 1.8°16 细分后每个脉冲对应 0.1125°。如果丝杆导程是 4 mm电机转一圈活塞前进 4 mm每个脉冲推进的距离就是 4 × 0.1125 / 360 0.00125 mm也就是 1.25 µm。这个数值是整个控速系统的“长度基准”所有流量设置都要先换算到它。流量换算公式推导并不复杂。设注射器内径为 d截面积 A π(d/2)²目标流量 Qml/h换算成每秒推进体积 V₀ Q × 1000 / 3600 mm³/s活塞推进速度 v V₀ / A最终脉冲频率 f v / 0.00125。实际做固件时不需要全程用浮点把 d 和丝杆导程配成常量预先算好“每 ml/h 对应多少 Hz”运行时直接用乘法。注射器规格内径约mm截面积mm²1 ml/h 推进速度µm/s1 ml/h 对应脉冲频率Hz5 ml12.5122.72.261.8110 ml14.5165.11.681.3520 ml19.0283.50.980.79注意 1 ml/h 对应的频率只有 1 Hz 级别这对定时器是个考验。后面会专门讲低频场景的脉冲生成方式而不是简单套用 PWM。2.3 加速曲线与堵转边界是监控的第一道门槛步进电机有一个启动频率上限直接给高频脉冲电机会丢步所以启动和调速都要走加速曲线。注射泵负载变化小梯形加速就够用S 型曲线在急停场景收益有限。梯形加减速要独立配置两个参数加速度和启动频率。实践中启动频率设在电机不失步的 1/10 左右比如目标是 500 Hz启动从 50 Hz 开始按 200 Hz/s 的加速度爬升。堵转的判别不只靠电机电流。正常运行时电机轴由丝杆带动活塞堵管后活塞阻力增大电机要么丢步要么被卡死此时编码器计数值和理论脉冲数的差值会越来越大。这个差值就是监控的核心指标。另外还可以用 STM32 定时器的输入捕获模式测 STEP 引脚的实时频率配合编码器计数两路信号交叉验证比只看一路可靠得多。提示编码器要用增量式200 线、4 倍频后每圈 800 个计数。1.8° 电机转一圈对应 800 个编码器计数每个脉冲理论对应 2 个计数判断丢步的阈值可以设成 5 个计数。3. STM32 motorcontrol 落地定时器 PWM 与监控代码3.1 用 STM32CubeMX 生成工程Keil MDK 编译现在开发 STM32 电机控制基本都走 STM32CubeMX 生成初始化代码、Keil MDK 编译调试的流程。CubeMX 里要关注的引脚和对应外设如下。功能外设引脚说明STEP 脉冲输出TIM1_CH1 PWMPA8中高速场景用 PWM方向控制GPIO 输出PB12高/低电平切换正反电机使能GPIO 输出PB13低电平使能驱动故障输入GPIO 输入PB14驱动芯片 FAULT 引脚编码器 A/BTIM3_CH1/CH2PB4/PB5编码器模式4 倍频电流采样ADC1_IN0PA0采样电阻经运放后接入OLEDI2C1PB8/PB9显示流速和累计量日志输出USART1PA9/PA10115200,8N1时钟树里把定时器时钟配成 72 MHzTIM1 分频设 71得到 1 MHz 的计数频率。这样 PWM 频率 1000000 / (ARR 1)ARR 从 0 到 65535输出频率范围约 15 Hz 到 1 MHz。初始化代码 CubeMX 会生成大部分只需要手动补上启动 PWM 的逻辑。3.2 中高速用 PWM超低频用定时中断翻转1 ml/h 的注射场景脉冲频率只有 1.35 HzARR 算出来是七十几万16 位定时器根本装不下。所以必须分成两套脉冲生成方案频率在 15 Hz 以上用 TIM1 PWM15 Hz 以下用 TIM6 基础定时器中断翻转 STEP 引脚。PWM 模式核心代码如下void Motor_SetSpeedHz(uint32_t hz) { uint16_t arr; uint16_t pulse; if (hz 0) { HAL_TIM_PWM_Stop(htim1, TIM_CHANNEL_1); return; } /* 频率 1MHz / (arr 1) */ arr (uint16_t)(1000000UL / hz - 1); pulse arr / 2; /* 占空比 50% */ __HAL_TIM_SET_AUTORELOAD(htim1, arr); __HAL_TIM_SET_COMPARE(htim1, TIM_CHANNEL_1, pulse); __HAL_TIM_SET_COUNTER(htim1, 0); if (HAL_TIM_PWM_GetState(htim1) ! HAL_TIM_STATE_BUSY) { HAL_TIM_PWM_Start(htim1, TIM_CHANNEL_1); } }这段代码有几个关键点。ARR 直接决定了输出频率占空比设成 50% 是因为步进驱动芯片只认边沿不需要微调脉宽更新 ARR 后强制把计数器清零避免旧的计数值直接和新的比较值匹配导致第一个脉冲宽度异常。切换速度时如果不清计数器电机可能在同一频率下突然多走半步累积多了就会位置偏移。低频翻转方案用 TIM6配置成 1 ms 中断每个中断里判断是否到达半周期翻转点。extern volatile uint32_t g_step_half_ms; /* 每半周期的毫秒数如 1.35Hz - 371ms */ volatile uint32_t g_step_ms_cnt 0; void TIM6_IRQHandler(void) { if (TIM_GET_FLAG(htim6, TIM_FLAG_UPDATE)) { if (g_step_half_ms 0) { if (g_step_ms_cnt g_step_half_ms) { g_step_ms_cnt 0; HAL_GPIO_TogglePin(STEP_GPIO_Port, STEP_Pin); } } TIM_CLEAR_FLAG(htim6, TIM_FLAG_UPDATE); } }g_step_half_ms 是半周期对应的 1 ms 中断次数。0.79 Hz 的半周期是 633 ms1.35 Hz 是 371 ms误差不超过 1 ms。两套方案切换时要保证同一时刻只有一个驱动 STEP 引脚启动 PWM 前先停止 TIM6 中断里的输出反过来也一样。3.3 编码器反馈与堵转判定代码TIM3 配成编码器模式硬件自动根据 A/B 相位差增减计数不需要在中断里处理正交解码。void Encoder_Init(void) { TIM_Encoder_InitTypeDef enc {0}; __HAL_RCC_TIM3_CLK_ENABLE(); enc.EncoderMode TIM_ENCODERMODE_TI12; enc.IC1Polarity TIM_ICPOLARITY_RISING; enc.IC2Polarity TIM_ICPOLARITY_RISING; enc.IC1Selection TIM_ICSELECTION_DIRECTTI; enc.IC2Selection TIM_ICSELECTION_DIRECTTI; enc.IC1Prescaler 0; enc.IC2Prescaler 0; enc.IC1Filter 10; enc.IC2Filter 10; HAL_TIM_Encoder_Init(htim3, enc); HAL_TIM_Encoder_Start(htim3, TIM_CHANNEL_ALL); }滤波系数设成 10可以滤掉机械振动带来的毛刺计数。堵转检测放到 1 ms 任务里执行和 TIM6 中断分开避免长时间停在中断函数里。int32_t g_last_encoder 0; uint32_t g_missed_ms 0; void Motor_MonitorTick(void) { int32_t now; int32_t delta; if (g_motor_state ! STATE_RUNNING) { return; } now (int32_t)__HAL_TIM_GET_COUNTER(htim3); delta now - g_last_encoder; g_last_encoder now; if (delta 0) { if (g_missed_ms 10) { Motor_Stop(); EnterAlarm(ALARM_BLOCKED); } } else { g_missed_ms 0; } }逻辑是电机在运行状态下连续 10 ms 编码器没有变化就判定堵转。判定的关键是根据方向区分正负 delta当前代码假设推注方向宏为正向反向时翻转 delta 的符号。堵转发生后立即停 PWM、置 ALARM 状态再配合蜂鸣器和 OLED 显示就构成一套完整的 STM32 电机保护链路。4. 智能注射控速系统的状态机与异常报警4.1 按键、OLED 与运行状态机注射过程不是简单启动就完事涉及暂停、继续、完成、报警多个状态。状态机的写法直接决定代码好不好维护状态切换表先定下来。当前状态触发事件下一状态动作IDLE按下启动RUNNING初始化脉冲参数使能电机RUNNING按下暂停PAUSE停止脉冲输出保持使能PAUSE按下启动RUNNING从当前位置继续RUNNING堵转/压力超限ALARM急停禁能电机RUNNING累计量达到目标COMPLETE正常停机提示完成ALARM按下复位IDLE清报警标志手动恢复状态机代码放在主循环里1 ms 监控任务只负责报警标志位不直接操作状态。typedef enum { STATE_IDLE, STATE_RUNNING, STATE_PAUSE, STATE_COMPLETE, STATE_ALARM } MotorState; void StateMachine_Run(void) { switch (g_state) { case STATE_IDLE: if (Key_StartPressed()) { Motor_Enable(); Motor_SetSpeedHz(g_target_hz); g_state STATE_RUNNING; } break; case STATE_RUNNING: if (g_alarm_flag ! ALARM_NONE) { Motor_Stop(); g_state STATE_ALARM; } else if (Key_PausePressed()) { Motor_Stop(); g_state STATE_PAUSE; } else if (g_total_ml g_target_ml) { Motor_Stop(); g_state STATE_COMPLETE; } break; case STATE_PAUSE: if (Key_StartPressed()) { Motor_Enable(); Motor_SetSpeedHz(g_target_hz); g_state STATE_RUNNING; } break; case STATE_ALARM: if (Key_ResetPressed() g_alarm_cause ALARM_NONE) { g_state STATE_IDLE; } break; default: g_state STATE_IDLE; break; } }OLED 的更新放到 100 ms 一次的低频任务里不要和状态机抢主循环。显示三行当前流速ml/h、累计注入量ml、状态名称。累计量计算用编码器实际读数除以每毫升对应的编码器计数不直接用理论脉冲数这样即使发生瞬时丢步也能在界面上看到偏差。4.2 电流与压力监控堵管检测的两种信号源堵管检测除了编码器方案还有两条路采样电机电流或者装压力传感器。电流采样的响应快但热态和冷态电流不同报警阈值不好定。压力传感器直接测注射器输出口的压力物理意义最明确。电流采样用采样电阻加 INA240 运放输出到 STM32 ADC。ADC 转换完成触发 DMA读取后在主循环做 8 点移动平均滤波。#define ADC_BUF_LEN 8 uint16_t g_adc_buf[ADC_BUF_LEN] {0}; uint32_t g_adc_sum 0; uint8_t g_adc_idx 0; uint16_t ADC_Filtered(void) { uint16_t val (uint16_t)HAL_ADC_GetValue(hadc1); g_adc_sum - g_adc_buf[g_adc_idx]; g_adc_buf[g_adc_idx] val; g_adc_sum val; g_adc_idx (g_adc_idx 1) % ADC_BUF_LEN; return (uint16_t)(g_adc_sum / ADC_BUF_LEN); }移动平均滤掉高频噪声后再做阈值持续判断。瞬时超过阈值不报警连续超过 200 ms 才触发防止按压输液管等瞬时扰动造成误报警。void Current_MonitorTick(void) { static uint16_t over_cnt 0; uint16_t cur; if (g_state ! STATE_RUNNING) { over_cnt 0; return; } cur ADC_Filtered(); if (cur g_current_alarm_th) { if (over_cnt 200) { g_alarm_flag ALARM_OVER_CURRENT; over_cnt 0; } } else { over_cnt 0; } }注意阈值要根据实际硬件标定空载、正常推注、堵管三组数据各测 10 次取堵管电流的 60% 作为报警下限。4.3 电机控制常见故障与排错MCU 控制电机不转先排除逻辑错误再怀疑硬件。下面这张表按我自己的排查习惯排列从信号看到功率级。故障现象可能原因排查手段电机完全不动ENA 电平错误万用表测 ENA 引脚对地电压电机完全不动STEP 无脉冲逻辑分析仪抓 PA8确认 PWM/翻转输出电机振动但不转DIR 方向错误活塞顶死在尽头先手动把丝杆转到中位再上电运行中丢步加速太急减小加速度启动频率降到目标频率 1/10运行中丢步电流设置不足调大驱动芯片电流到额定 80%累计量偏小编码器读数被低通滤波滤掉确认 TIM3 边沿滤波系数不要超过 10频繁复位供电跌落堵转电流大示波器测 5V/12V 轨加 470µF 电容排查时先看驱动芯片的 FAULT 引脚FAULT 拉低说明过流或过热。其次看 MCU 是否进入了 HardFaultTIM 周期中断里禁止调用 HAL_Delay否则中断嵌套会把 1 ms 时序打乱直接导致 STEP 间隔抖动。5. 用标定和验证压住智能注射控速系统的精度5.1 用逻辑分析仪核验脉冲输出板上电后先不装注射器把逻辑分析仪接到 STEP 引脚采样率设 25 MHz录 10 秒数脉冲个数除以时间得到实测频率。比如目标 100 Hz10 秒应数出 1000 个脉冲误差超过 ±2 个就要检查定时器分频和 ARR 计算。低频翻转场景下用逻辑分析仪直接数脉冲是验证 TIM6 方案最直接的手段。5.2 多段速度曲线与临床输注方案实际输注场景往往需要阶段性改变速度比如前 5 分钟快速补液、之后缓慢维持。把输液计划做成表驱动主循环每秒查一次当前时段的目标流速并调用Motor_SetSpeedHz。时段起点min时段终点min目标流速ml/h0512052060206020段与段之间切换时不能直接跳频要先按当前速度的 1/10 重新走梯形加速曲线否则高速切低速时容易过冲丢步。加速过程在 1 ms 监控任务里完成每个周期把目标频率步进 5%直到达到新时段的目标值。5.3 串口日志对比目标与实际速度曲线验证整个监控系统是否有效的办法是把目标脉冲数、编码器实际读数、电流值通过串口打出来。printf(%lu,%lu,%ld,%u,%d\r\n, HAL_GetTick(), g_target_pulse_count, (long)(__HAL_TIM_GET_COUNTER(htim3) - g_target_pulse_count), (unsigned)ADC_Filtered(), g_state);一帧五列数据时间戳、理论累计脉冲、实际与理论差值、滤波后电流、状态码。串口助手按 CSV 存文件用 Excel 或 Python 画“差值-时间”散点图。正常运行曲线在 0 附近小幅度波动堵转瞬间曲线出现陡增并一路拉高电流值同步上升这个拐点就是丢步发生的确切时刻。把日志存成 CSV观察差值超过 ±2 个脉冲的时刻对照驱动电流波形定位是机械卡滞还是驱动芯片过热。本文还有配套的精品资源点击获取
简介面向医疗电子与嵌入式开发者STM32智能注射控速系统方案涵盖电机控制、脉搏监测、液晶显示和嵌入式软件设计。系统以STM32为核心通过PWM精准调节注射速率利用PPG/ECG传感器实时采集脉搏信号异常时自动调整或停止注射对医疗输液场景有直接参考价值。包内共225个文件压缩包约5.6MB以C/H源码、Keil工程文件、编译生成的axf/hex/map文件为主并含配置脚本和说明文档便于查看完整工程架构、跟踪代码逻辑及烧录验证覆盖从开发到编译的各个环节。已有116人学习下载适合正在开展STM32电机控制、注射泵或生物信号处理项目的研究者。借助源码与工程可快速理解ADC采集、信号滤波、PWM驱动等完整链路也可作为课程设计或医疗设备原型开发的参考范本。1. STM32监控与智能注射控速系统的技术边界病房里的注射泵、实验室里的微量注射泵、产线上的定量注液设备工作方式都是一样的步进电机通过丝杆推动注射器活塞以设定的 ml/h 速度把液体推出去。见过最多的故障不是电机不转而是电机在转、编码器没动液体没走系统还在傻傻地报“正常”。这个标题里的STM32监控指的不是监控电压和温度而是监控“电机轴到底有没有按指令走”stm32电机和motorcontrolstm32说的是步进电机驱动这一层最终落点是智能注射控速系统的流量闭环和安全保护。这套方案比较适合三类人做医疗器械嵌入式开发、做毕业设计选择 STM32 电机控制课题、改造现有注液设备但不想引入伺服系统的人。2. 注射控速原理步进电机选型与流量换算2.1 为什么注射泵选步进电机而不是直流或伺服电机注射泵的速度范围通常在 0.1 ml/h 到 1000 ml/h 之间换算成电机转速大部分时间电机轴每分钟只转几圈到几十圈。这种低速场景下直流有刷电机要配减速箱加编码器才能定位伺服电机的成本又偏高步进电机却有先天优势低速扭矩大、开环就能保持位置、控制接口只需要 STEP/DIR/ENA 三根线。常见的做法是用 A4988 或 DRV8825 做驱动芯片对噪声敏感的场合换 TMC2209靠硬件细分就能把低频振动压下去。驱动层的接线固定一套模式MCU 的 GPIO 接 DIR 控制方向PWM 或定时器翻转接 STEP 控制步进脉冲ENA 控制使能。注意一点A4988 和 DRV8825 的 ENA 电平逻辑不一样A4988 低电平使能DRV8825 默认低电平使能但有些模块做了反向上电先测一组空转脉冲确认方向再装到注射器上。选型时要把电机额定电流和驱动芯片的电流设置电阻算清楚。注射泵负载一般是丝杆加注射器活塞阻力不大但堵管时电流会明显上升。我一般会把驱动电流调到电机额定电流的 80%既保证正常运行扭矩又给堵转检测留出电流余量。2.2 细分、步距角与速度-流量换算步进电机常见步距角是 1.8°16 细分后每个脉冲对应 0.1125°。如果丝杆导程是 4 mm电机转一圈活塞前进 4 mm每个脉冲推进的距离就是 4 × 0.1125 / 360 0.00125 mm也就是 1.25 µm。这个数值是整个控速系统的“长度基准”所有流量设置都要先换算到它。流量换算公式推导并不复杂。设注射器内径为 d截面积 A π(d/2)²目标流量 Qml/h换算成每秒推进体积 V₀ Q × 1000 / 3600 mm³/s活塞推进速度 v V₀ / A最终脉冲频率 f v / 0.00125。实际做固件时不需要全程用浮点把 d 和丝杆导程配成常量预先算好“每 ml/h 对应多少 Hz”运行时直接用乘法。注射器规格内径约mm截面积mm²1 ml/h 推进速度µm/s1 ml/h 对应脉冲频率Hz5 ml12.5122.72.261.8110 ml14.5165.11.681.3520 ml19.0283.50.980.79注意 1 ml/h 对应的频率只有 1 Hz 级别这对定时器是个考验。后面会专门讲低频场景的脉冲生成方式而不是简单套用 PWM。2.3 加速曲线与堵转边界是监控的第一道门槛步进电机有一个启动频率上限直接给高频脉冲电机会丢步所以启动和调速都要走加速曲线。注射泵负载变化小梯形加速就够用S 型曲线在急停场景收益有限。梯形加减速要独立配置两个参数加速度和启动频率。实践中启动频率设在电机不失步的 1/10 左右比如目标是 500 Hz启动从 50 Hz 开始按 200 Hz/s 的加速度爬升。堵转的判别不只靠电机电流。正常运行时电机轴由丝杆带动活塞堵管后活塞阻力增大电机要么丢步要么被卡死此时编码器计数值和理论脉冲数的差值会越来越大。这个差值就是监控的核心指标。另外还可以用 STM32 定时器的输入捕获模式测 STEP 引脚的实时频率配合编码器计数两路信号交叉验证比只看一路可靠得多。提示编码器要用增量式200 线、4 倍频后每圈 800 个计数。1.8° 电机转一圈对应 800 个编码器计数每个脉冲理论对应 2 个计数判断丢步的阈值可以设成 5 个计数。3. STM32 motorcontrol 落地定时器 PWM 与监控代码3.1 用 STM32CubeMX 生成工程Keil MDK 编译现在开发 STM32 电机控制基本都走 STM32CubeMX 生成初始化代码、Keil MDK 编译调试的流程。CubeMX 里要关注的引脚和对应外设如下。功能外设引脚说明STEP 脉冲输出TIM1_CH1 PWMPA8中高速场景用 PWM方向控制GPIO 输出PB12高/低电平切换正反电机使能GPIO 输出PB13低电平使能驱动故障输入GPIO 输入PB14驱动芯片 FAULT 引脚编码器 A/BTIM3_CH1/CH2PB4/PB5编码器模式4 倍频电流采样ADC1_IN0PA0采样电阻经运放后接入OLEDI2C1PB8/PB9显示流速和累计量日志输出USART1PA9/PA10115200,8N1时钟树里把定时器时钟配成 72 MHzTIM1 分频设 71得到 1 MHz 的计数频率。这样 PWM 频率 1000000 / (ARR 1)ARR 从 0 到 65535输出频率范围约 15 Hz 到 1 MHz。初始化代码 CubeMX 会生成大部分只需要手动补上启动 PWM 的逻辑。3.2 中高速用 PWM超低频用定时中断翻转1 ml/h 的注射场景脉冲频率只有 1.35 HzARR 算出来是七十几万16 位定时器根本装不下。所以必须分成两套脉冲生成方案频率在 15 Hz 以上用 TIM1 PWM15 Hz 以下用 TIM6 基础定时器中断翻转 STEP 引脚。PWM 模式核心代码如下void Motor_SetSpeedHz(uint32_t hz) { uint16_t arr; uint16_t pulse; if (hz 0) { HAL_TIM_PWM_Stop(htim1, TIM_CHANNEL_1); return; } /* 频率 1MHz / (arr 1) */ arr (uint16_t)(1000000UL / hz - 1); pulse arr / 2; /* 占空比 50% */ __HAL_TIM_SET_AUTORELOAD(htim1, arr); __HAL_TIM_SET_COMPARE(htim1, TIM_CHANNEL_1, pulse); __HAL_TIM_SET_COUNTER(htim1, 0); if (HAL_TIM_PWM_GetState(htim1) ! HAL_TIM_STATE_BUSY) { HAL_TIM_PWM_Start(htim1, TIM_CHANNEL_1); } }这段代码有几个关键点。ARR 直接决定了输出频率占空比设成 50% 是因为步进驱动芯片只认边沿不需要微调脉宽更新 ARR 后强制把计数器清零避免旧的计数值直接和新的比较值匹配导致第一个脉冲宽度异常。切换速度时如果不清计数器电机可能在同一频率下突然多走半步累积多了就会位置偏移。低频翻转方案用 TIM6配置成 1 ms 中断每个中断里判断是否到达半周期翻转点。extern volatile uint32_t g_step_half_ms; /* 每半周期的毫秒数如 1.35Hz - 371ms */ volatile uint32_t g_step_ms_cnt 0; void TIM6_IRQHandler(void) { if (TIM_GET_FLAG(htim6, TIM_FLAG_UPDATE)) { if (g_step_half_ms 0) { if (g_step_ms_cnt g_step_half_ms) { g_step_ms_cnt 0; HAL_GPIO_TogglePin(STEP_GPIO_Port, STEP_Pin); } } TIM_CLEAR_FLAG(htim6, TIM_FLAG_UPDATE); } }g_step_half_ms 是半周期对应的 1 ms 中断次数。0.79 Hz 的半周期是 633 ms1.35 Hz 是 371 ms误差不超过 1 ms。两套方案切换时要保证同一时刻只有一个驱动 STEP 引脚启动 PWM 前先停止 TIM6 中断里的输出反过来也一样。3.3 编码器反馈与堵转判定代码TIM3 配成编码器模式硬件自动根据 A/B 相位差增减计数不需要在中断里处理正交解码。void Encoder_Init(void) { TIM_Encoder_InitTypeDef enc {0}; __HAL_RCC_TIM3_CLK_ENABLE(); enc.EncoderMode TIM_ENCODERMODE_TI12; enc.IC1Polarity TIM_ICPOLARITY_RISING; enc.IC2Polarity TIM_ICPOLARITY_RISING; enc.IC1Selection TIM_ICSELECTION_DIRECTTI; enc.IC2Selection TIM_ICSELECTION_DIRECTTI; enc.IC1Prescaler 0; enc.IC2Prescaler 0; enc.IC1Filter 10; enc.IC2Filter 10; HAL_TIM_Encoder_Init(htim3, enc); HAL_TIM_Encoder_Start(htim3, TIM_CHANNEL_ALL); }滤波系数设成 10可以滤掉机械振动带来的毛刺计数。堵转检测放到 1 ms 任务里执行和 TIM6 中断分开避免长时间停在中断函数里。int32_t g_last_encoder 0; uint32_t g_missed_ms 0; void Motor_MonitorTick(void) { int32_t now; int32_t delta; if (g_motor_state ! STATE_RUNNING) { return; } now (int32_t)__HAL_TIM_GET_COUNTER(htim3); delta now - g_last_encoder; g_last_encoder now; if (delta 0) { if (g_missed_ms 10) { Motor_Stop(); EnterAlarm(ALARM_BLOCKED); } } else { g_missed_ms 0; } }逻辑是电机在运行状态下连续 10 ms 编码器没有变化就判定堵转。判定的关键是根据方向区分正负 delta当前代码假设推注方向宏为正向反向时翻转 delta 的符号。堵转发生后立即停 PWM、置 ALARM 状态再配合蜂鸣器和 OLED 显示就构成一套完整的 STM32 电机保护链路。4. 智能注射控速系统的状态机与异常报警4.1 按键、OLED 与运行状态机注射过程不是简单启动就完事涉及暂停、继续、完成、报警多个状态。状态机的写法直接决定代码好不好维护状态切换表先定下来。当前状态触发事件下一状态动作IDLE按下启动RUNNING初始化脉冲参数使能电机RUNNING按下暂停PAUSE停止脉冲输出保持使能PAUSE按下启动RUNNING从当前位置继续RUNNING堵转/压力超限ALARM急停禁能电机RUNNING累计量达到目标COMPLETE正常停机提示完成ALARM按下复位IDLE清报警标志手动恢复状态机代码放在主循环里1 ms 监控任务只负责报警标志位不直接操作状态。typedef enum { STATE_IDLE, STATE_RUNNING, STATE_PAUSE, STATE_COMPLETE, STATE_ALARM } MotorState; void StateMachine_Run(void) { switch (g_state) { case STATE_IDLE: if (Key_StartPressed()) { Motor_Enable(); Motor_SetSpeedHz(g_target_hz); g_state STATE_RUNNING; } break; case STATE_RUNNING: if (g_alarm_flag ! ALARM_NONE) { Motor_Stop(); g_state STATE_ALARM; } else if (Key_PausePressed()) { Motor_Stop(); g_state STATE_PAUSE; } else if (g_total_ml g_target_ml) { Motor_Stop(); g_state STATE_COMPLETE; } break; case STATE_PAUSE: if (Key_StartPressed()) { Motor_Enable(); Motor_SetSpeedHz(g_target_hz); g_state STATE_RUNNING; } break; case STATE_ALARM: if (Key_ResetPressed() g_alarm_cause ALARM_NONE) { g_state STATE_IDLE; } break; default: g_state STATE_IDLE; break; } }OLED 的更新放到 100 ms 一次的低频任务里不要和状态机抢主循环。显示三行当前流速ml/h、累计注入量ml、状态名称。累计量计算用编码器实际读数除以每毫升对应的编码器计数不直接用理论脉冲数这样即使发生瞬时丢步也能在界面上看到偏差。4.2 电流与压力监控堵管检测的两种信号源堵管检测除了编码器方案还有两条路采样电机电流或者装压力传感器。电流采样的响应快但热态和冷态电流不同报警阈值不好定。压力传感器直接测注射器输出口的压力物理意义最明确。电流采样用采样电阻加 INA240 运放输出到 STM32 ADC。ADC 转换完成触发 DMA读取后在主循环做 8 点移动平均滤波。#define ADC_BUF_LEN 8 uint16_t g_adc_buf[ADC_BUF_LEN] {0}; uint32_t g_adc_sum 0; uint8_t g_adc_idx 0; uint16_t ADC_Filtered(void) { uint16_t val (uint16_t)HAL_ADC_GetValue(hadc1); g_adc_sum - g_adc_buf[g_adc_idx]; g_adc_buf[g_adc_idx] val; g_adc_sum val; g_adc_idx (g_adc_idx 1) % ADC_BUF_LEN; return (uint16_t)(g_adc_sum / ADC_BUF_LEN); }移动平均滤掉高频噪声后再做阈值持续判断。瞬时超过阈值不报警连续超过 200 ms 才触发防止按压输液管等瞬时扰动造成误报警。void Current_MonitorTick(void) { static uint16_t over_cnt 0; uint16_t cur; if (g_state ! STATE_RUNNING) { over_cnt 0; return; } cur ADC_Filtered(); if (cur g_current_alarm_th) { if (over_cnt 200) { g_alarm_flag ALARM_OVER_CURRENT; over_cnt 0; } } else { over_cnt 0; } }注意阈值要根据实际硬件标定空载、正常推注、堵管三组数据各测 10 次取堵管电流的 60% 作为报警下限。4.3 电机控制常见故障与排错MCU 控制电机不转先排除逻辑错误再怀疑硬件。下面这张表按我自己的排查习惯排列从信号看到功率级。故障现象可能原因排查手段电机完全不动ENA 电平错误万用表测 ENA 引脚对地电压电机完全不动STEP 无脉冲逻辑分析仪抓 PA8确认 PWM/翻转输出电机振动但不转DIR 方向错误活塞顶死在尽头先手动把丝杆转到中位再上电运行中丢步加速太急减小加速度启动频率降到目标频率 1/10运行中丢步电流设置不足调大驱动芯片电流到额定 80%累计量偏小编码器读数被低通滤波滤掉确认 TIM3 边沿滤波系数不要超过 10频繁复位供电跌落堵转电流大示波器测 5V/12V 轨加 470µF 电容排查时先看驱动芯片的 FAULT 引脚FAULT 拉低说明过流或过热。其次看 MCU 是否进入了 HardFaultTIM 周期中断里禁止调用 HAL_Delay否则中断嵌套会把 1 ms 时序打乱直接导致 STEP 间隔抖动。5. 用标定和验证压住智能注射控速系统的精度5.1 用逻辑分析仪核验脉冲输出板上电后先不装注射器把逻辑分析仪接到 STEP 引脚采样率设 25 MHz录 10 秒数脉冲个数除以时间得到实测频率。比如目标 100 Hz10 秒应数出 1000 个脉冲误差超过 ±2 个就要检查定时器分频和 ARR 计算。低频翻转场景下用逻辑分析仪直接数脉冲是验证 TIM6 方案最直接的手段。5.2 多段速度曲线与临床输注方案实际输注场景往往需要阶段性改变速度比如前 5 分钟快速补液、之后缓慢维持。把输液计划做成表驱动主循环每秒查一次当前时段的目标流速并调用Motor_SetSpeedHz。时段起点min时段终点min目标流速ml/h0512052060206020段与段之间切换时不能直接跳频要先按当前速度的 1/10 重新走梯形加速曲线否则高速切低速时容易过冲丢步。加速过程在 1 ms 监控任务里完成每个周期把目标频率步进 5%直到达到新时段的目标值。5.3 串口日志对比目标与实际速度曲线验证整个监控系统是否有效的办法是把目标脉冲数、编码器实际读数、电流值通过串口打出来。printf(%lu,%lu,%ld,%u,%d\r\n, HAL_GetTick(), g_target_pulse_count, (long)(__HAL_TIM_GET_COUNTER(htim3) - g_target_pulse_count), (unsigned)ADC_Filtered(), g_state);一帧五列数据时间戳、理论累计脉冲、实际与理论差值、滤波后电流、状态码。串口助手按 CSV 存文件用 Excel 或 Python 画“差值-时间”散点图。正常运行曲线在 0 附近小幅度波动堵转瞬间曲线出现陡增并一路拉高电流值同步上升这个拐点就是丢步发生的确切时刻。把日志存成 CSV观察差值超过 ±2 个脉冲的时刻对照驱动电流波形定位是机械卡滞还是驱动芯片过热。本文还有配套的精品资源点击获取
