STM32F103C8T6 智能输液系统实战：红外滴速检测与步进电机PID控制（附完整代码）

STM32F103C8T6智能输液系统实战从红外滴速检测到闭环PID控制在医疗护理领域静脉输液是最基础也最频繁的操作之一。传统输液过程完全依赖医护人员手动调节和肉眼观察不仅增加了工作负担更存在滴速失控、液位监测不及时等安全隐患。本文将带你深入一个完整的智能输液系统开发过程从硬件选型到PID算法实现逐步构建一个基于STM32F103的闭环控制系统。1. 系统架构设计与硬件选型1.1 核心控制器STM32F103C8T6这款Cortex-M3内核的MCU以72MHz主频和丰富外设成为医疗级嵌入式设备的理想选择// STM32时钟配置示例使用HSE 8MHz晶振 void SystemClock_Config(void) { RCC_OscInitTypeDef RCC_OscInitStruct {0}; RCC_ClkInitTypeDef RCC_ClkInitStruct {0}; // 配置HSE振荡器 RCC_OscInitStruct.OscillatorType RCC_OSCILLATORTYPE_HSE; RCC_OscInitStruct.HSEState RCC_HSE_ON; RCC_OscInitStruct.PLL.PLLState RCC_PLL_ON; RCC_OscInitStruct.PLL.PLLSource RCC_PLLSOURCE_HSE; RCC_OscInitStruct.PLL.PLLMUL RCC_PLL_MUL9; // 8MHz * 9 72MHz HAL_RCC_OscConfig(RCC_OscInitStruct); // 配置时钟树 RCC_ClkInitStruct.ClockType RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2; RCC_ClkInitStruct.SYSCLKSource RCC_SYSCLKSOURCE_PLLCLK; RCC_ClkInitStruct.AHBCLKDivider RCC_SYSCLK_DIV1; RCC_ClkInitStruct.APB1CLKDivider RCC_HCLK_DIV2; // 36MHz RCC_ClkInitStruct.APB2CLKDivider RCC_HCLK_DIV1; // 72MHz HAL_RCC_ClockConfig(RCC_ClkInitStruct, FLASH_LATENCY_2); }关键外设资源分配表外设功能引脚配置参数TIM3滴速计算-1秒定时72MHz/720001kHzEXTI3滴落中断PB3上升沿触发ADC1液位检测PB012位分辨率239.5周期采样GPIO电机控制PB8-9, PA12,15推挽输出50MHzUSART1调试输出PA9-10115200bps, 8N11.2 滴速检测模块优化采用槽型红外对管如ITR9909配合LM393比较器构成数字式滴速传感器。关键设计要点光学结构设计发射管电流限制在20mA以内串联150Ω电阻接收管与发射管成45°夹角避免直射干扰滴管位置处于光束焦点处信号调理电路VCC(3.3V) ──┬── IR_LED ──|─┬─ 150Ω ── GND │ │ └── LM393() ←─┘ │ PB3 ──────── LM393(OUT)抗干扰措施在比较器输出端添加0.1μF去耦电容软件实现50ms消抖滤波1.3 执行机构步进电机驱动方案选用28BYJ-48五线四相步进电机配合ULN2003驱动芯片其半步驱动时序如下步序IN1IN2IN3IN4励磁方式11000A相21100AB相30100B相..................电机驱动代码片段void Stepper_Run(int steps, uint8_t dir) { static const uint8_t phase[] {0x09,0x08,0x0C,0x04,0x06,0x02,0x03,0x01}; static uint8_t phase_idx 0; for(int i0; iabs(steps); i) { dir ? phase_idx : phase_idx--; phase_idx 0x07; MOTOR_PORT-ODR (MOTOR_PORT-ODR 0xFFF0) | phase[phase_idx]; HAL_Delay(2); // 控制转速的关键参数 } }2. 滴速检测算法实现2.1 外部中断与定时器协同采用脉冲计数定时采样方法实现滴速测量volatile uint32_t drop_count 0; uint16_t current_speed 0; // 滴/分钟 // EXTI中断服务函数 void EXTI3_IRQHandler(void) { if(EXTI-PR EXTI_PR_PR3) { drop_count; EXTI-PR EXTI_PR_PR3; // 清除中断标志 } } // TIM3 1秒定时中断 void TIM3_IRQHandler(void) { if(TIM3-SR TIM_SR_UIF) { current_speed drop_count * 60; drop_count 0; TIM3-SR ~TIM_SR_UIF; } }2.2 数字滤波处理为消除异常滴落检测采用移动平均滤波#define FILTER_WINDOW 5 uint16_t speed_filter_buf[FILTER_WINDOW] {0}; uint8_t filter_idx 0; uint16_t Apply_Filter(uint16_t new_val) { static uint32_t sum 0; sum - speed_filter_buf[filter_idx]; speed_filter_buf[filter_idx] new_val; sum new_val; filter_idx (filter_idx 1) % FILTER_WINDOW; return sum / FILTER_WINDOW; }3. PID控制算法实现与调参3.1 增量式PID实现针对输液系统特点采用增量式PID避免积分饱和typedef struct { float Kp, Ki, Kd; float last_error; float prev_error; int output; int output_limit; } PID_Controller; void PID_Init(PID_Controller* pid, float kp, float ki, float kd, int limit) { pid-Kp kp; pid-Ki ki; pid-Kd kd; pid-output_limit limit; pid-last_error pid-prev_error 0; } int PID_Update(PID_Controller* pid, float setpoint, float pv) { float error setpoint - pv; float delta (error - pid-last_error); // 比例项 float p_term pid-Kp * delta; // 积分项抗积分饱和 float i_term pid-Ki * error; if(fabs(pid-output i_term) pid-output_limit) { i_term 0; } // 微分项带滤波 float d_term pid-Kd * (error - 2*pid-last_error pid-prev_error); // 计算输出增量 int output pid-output p_term i_term d_term; // 输出限幅 if(output pid-output_limit) output pid-output_limit; if(output -pid-output_limit) output -pid-output_limit; // 更新状态 pid-prev_error pid-last_error; pid-last_error error; pid-output output; return output; }3.2 参数整定方法采用Ziegler-Nichols法则进行初步调参纯比例控制逐渐增大Kp直到系统出现等幅振荡临界增益Ku记录振荡周期测量临界振荡周期Tu计算PID参数Kp 0.6 * KuKi 2 * Kp / TuKd Kp * Tu / 8典型参数范围参考表参数作用调整方向典型值范围Kp响应速度↑ 加快响应但可能超调1.0-5.0Ki消除静差↑ 加快稳态但可能振荡0.01-0.5Kd抑制超调↑ 增强阻尼但降低响应0.1-2.04. 系统集成与性能优化4.1 状态机设计采用有限状态机管理输液过程stateDiagram-v2 [*] -- IDLE IDLE -- PRIMING: 启动输液 PRIMING -- RUNNING: 滴速稳定 RUNNING -- ALARM: 异常检测 ALARM -- RUNNING: 人工确认 RUNNING -- COMPLETE: 液位为空 COMPLETE -- IDLE: 重置系统对应代码实现typedef enum { SYS_IDLE, SYS_PRIMING, SYS_RUNNING, SYS_ALARM, SYS_COMPLETE } SystemState; void System_Update(void) { static SystemState state SYS_IDLE; static uint32_t stable_time 0; switch(state) { case SYS_IDLE: if(start_button_pressed()) { Motor_Start(); state SYS_PRIMING; } break; case SYS_PRIMING: if(abs(current_speed - target_speed) 5) { stable_time; if(stable_time 3000) { // 稳定3秒 state SYS_RUNNING; } } else { stable_time 0; } break; case SYS_RUNNING: if(fluid_level 10) { state SYS_COMPLETE; } else if(speed_error 20) { state SYS_ALARM; } break; // 其他状态处理... } }4.2 安全保护机制硬件看门狗IWDG_HandleTypeDef hiwdg; void IWDG_Init(void) { hiwdg.Instance IWDG; hiwdg.Init.Prescaler IWDG_PRESCALER_32; // 32kHz/321kHz hiwdg.Init.Reload 1000; // 1秒超时 HAL_IWDG_Init(hiwdg); } void Feed_Dog(void) { HAL_IWDG_Refresh(hiwdg); }软件容错设计ADC采样值范围校验电机堵转检测电流监测滴速突变检测50%变化率视为故障5. 实测数据分析与系统验证5.1 阶跃响应测试设置目标滴速从0到60滴/分钟的阶跃变化记录系统响应时间(s)实测滴速电机控制量备注000阶跃输入11570%上升阶段24550%接近目标值35842%进入调节阶段560±240-45%稳态波动范围5.2 抗干扰测试人为制造滴速扰动±20滴/分钟观察恢复时间扰动幅度恢复时间(s)超调量评价等级202.18%优良-202.55%优良303.215%合格6. 进阶功能扩展6.1 蓝牙远程监控集成HC-05蓝牙模块实现无线监测void Bluetooth_Send(void) { char buf[64]; snprintf(buf, sizeof(buf), SPD:%03d LVL:%03d TEMP:%2.1f\n, current_speed, fluid_level, temperature); HAL_UART_Transmit(huart1, (uint8_t*)buf, strlen(buf), 100); }配套Android应用可显示实时曲线和历史数据。6.2 温度补偿系统加入DS18B20温度传感器实现药液温度监测float Read_Temperature(void) { uint8_t temp[2]; DS18B20_Start(); DS18B20_Read(temp); return (temp[1]8 | temp[0]) * 0.0625; } void Temp_Compensation(void) { float temp Read_Temperature(); if(temp 20) { PID_Setpoint_Adjust(1.05); // 低温时适当提高目标滴速 } else if(temp 30) { PID_Setpoint_Adjust(0.95); // 高温时适当降低目标滴速 } }7. 常见问题解决方案问题1滴速检测不稳定可能原因红外对管灵敏度不足环境光干扰机械振动影响解决方案调整比较器参考电压增加遮光罩软件增加中值滤波问题2电机响应滞后优化方法// 动态调整PID计算周期 void Adjust_PID_Period(uint16_t error) { static uint16_t period 100; // 默认100ms if(abs(error) 20) { period 50; // 大偏差时加快计算 } else { period 100 (10 - abs(error)/2)*10; // 误差越小周期越长 } TIM_SetAutoreload(PID_TIM, period); }问题3液位检测误差校准步骤空瓶状态下读取ADC值AD_min满瓶状态下读取ADC值AD_max应用线性插值公式uint8_t Calculate_Level(uint16_t adc_val) { const uint16_t AD_min 820, AD_max 3100; return (adc_val - AD_min) * 100 / (AD_max - AD_min); }8. 完整工程代码结构/Project │── /Core │ ├── main.c # 主循环和状态机 │ ├── stm32f1xx_it.c # 中断服务程序 │── /Drivers │ ├── pid_controller.c # PID算法实现 │ ├── droplet_sensor.c # 滴速检测处理 │ ├── motor_control.c # 步进电机驱动 │ ├── lcd1602.c # 显示模块驱动 │── /Inc │ ├── config.h # 参数配置文件 │── /Middlewares │ ├── ring_buffer.c # 串口数据缓冲 │── /STM32F1xx_HAL_Driver # HAL库文件关键配置文件示例config.h#pragma once // 系统参数配置 #define TARGET_DROP_RATE 60 // 目标滴速滴/分钟 #define DROP_RATE_TOLERANCE 5 // 允许误差范围 #define MAX_MOTOR_SPEED 80 // 电机最大速度% // PID参数 #define PID_KP 2.5f #define PID_KI 0.1f #define PID_KD 0.8f #define PID_OUTPUT_LIMIT 100 // 硬件引脚定义 #define MOTOR_PORT GPIOB #define MOTOR_PIN1 GPIO_PIN_8 #define MOTOR_PIN2 GPIO_PIN_9 #define DROP_SENSOR_PIN GPIO_PIN_3实际开发中建议使用STM32CubeMX生成基础工程框架再添加业务逻辑代码。整个系统在保持低成本的同时BOM成本100元实现了医疗级输液控制精度±2滴/分钟。