STM32单片机电机PID控制技术详解

STM32单片机实现电机PID控制技术解析1. 项目概述PID控制算法作为经典控制理论的核心算法在工业控制领域已有近百年的应用历史。在电机控制场景中PID算法通过调节PWM占空比实现对电机转速或位置的精确控制。本项目基于STM32单片机平台实现了位置式和增量式两种PID控制方案适用于直流有刷电机、步进电机等多种电机类型的闭环控制。1.1 系统架构系统采用典型的闭环控制架构[目标值] → [PID控制器] → [电机驱动] → [电机] → [编码器反馈] → [STM32处理]其中关键组件包括STM32F103系列MCU作为控制核心运行PID算法正交编码器用于位置/速度检测500-1000线H桥驱动电路如DRV8833、TB6612等电机驱动ICPWM输出定时器产生16位分辨率PWM信号2. 位置式PID实现2.1 算法原理位置式PID又称全量式PID的离散化公式为u(k) Kp*e(k) Ki*∑e(j) Kd*[e(k)-e(k-1)]其中u(k)当前控制量输出PWM占空比e(k)当前误差目标值-反馈值Kp比例系数Ki积分系数Kd微分系数2.2 STM32实现代码int Position_PID(int Encoder, int Target) { static float Bias, Pwm, Integral_bias, Last_Bias; Bias Target - Encoder; // 计算偏差 Integral_bias Bias; // 偏差积分 Pwm Position_KP * Bias Position_KI * Integral_bias Position_KD * (Bias - Last_Bias); Last_Bias Bias; // 保存历史偏差 return Pwm; // 输出PWM值 }关键参数说明Position_KP比例系数影响系统响应速度Position_KI积分系数消除稳态误差Position_KD微分系数抑制超调2.3 工程实现要点采样周期选择建议1-10ms根据电机响应特性调整使用STM32定时器触发中断实现积分抗饱和处理if(Integral_bias 1000) Integral_bias 1000; else if(Integral_bias -1000) Integral_bias -1000;输出限幅if(Pwm 1000) Pwm 1000; else if(Pwm -1000) Pwm -1000;3. 增量式PID实现3.1 算法原理增量式PID计算公式简化为Δu(k) Kp*[e(k)-e(k-1)] Ki*e(k)特点只输出控制量增量天然具有抗积分饱和特性适用于执行机构带积分特性的场合3.2 STM32实现代码int Incremental_PI(int Encoder, int Target) { static float Bias, Pwm, Last_bias; Bias Encoder - Target; // 计算偏差 Pwm Velocity_KP * (Bias - Last_bias) Velocity_KI * Bias; Last_bias Bias; // 保存历史偏差 return Pwm; // 输出PWM增量 }3.3 速度测量实现采用M法测速固定时间测脉冲数// 定时器中断服务函数 void TIM2_IRQHandler(void) { if(TIM_GetITStatus(TIM2, TIM_IT_Update) ! RESET) { Speed Encoder_Count; // 获取脉冲计数 Encoder_Count 0; // 计数器清零 TIM_ClearITPendingBit(TIM2, TIM_IT_Update); } }4. PID参数整定方法4.1 参数影响分析参数响应速度超调量稳态误差抗干扰性Kp↑↑↓↑Ki-↑↓↓↑Kd↓↓↓-↑4.2 工程调参步骤初始参数设定先设Ki0, Kd0逐步增大Kp至系统出现等幅振荡Ziegler-Nichols法记录临界增益Ku和振荡周期Tu按以下规则设置参数控制类型KpKiKdP0.5Ku00PI0.45Ku0.54Ku/Tu0PID0.6Ku1.2Ku/Tu0.075Ku*Tu现场微调先调Kp满足响应速度再调Ki消除静差最后加Kd抑制超调5. 硬件设计要点5.1 电机驱动电路典型H桥驱动设计参数功率MOSFET选型VDS 2倍电源电压栅极驱动电流≥1A快速开关死区时间500ns-1μs防止直通5.2 编码器接口STM32编码器模式配置void Encoder_Init(void) { TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_ICInitTypeDef TIM_ICInitStructure; // 定时器时钟使能 RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); // 编码器接口配置 TIM_EncoderInterfaceConfig(TIM3, TIM_EncoderMode_TI12, TIM_ICPolarity_Rising, TIM_ICPolarity_Rising); TIM_ICStructInit(TIM_ICInitStructure); TIM_ICInitStructure.TIM_ICFilter 6; // 数字滤波 TIM_ICInit(TIM3, TIM_ICInitStructure); TIM_Cmd(TIM3, ENABLE); // 使能定时器 }5.3 抗干扰设计电源去耦每芯片0.1μF陶瓷电容电机电源端100-470μF电解电容信号隔离编码器信号采用磁耦隔离如ADuM1201PWM信号光耦隔离如TLP521接地策略数字地与功率地单点连接编码器屏蔽层接地6. 系统性能优化6.1 变参数PID根据误差大小动态调整参数if(abs(Bias) 100) { // 大误差区加强比例作用 Kp Kp1; Ki Ki1; Kd Kd1; } else { // 小误差区加强积分作用 Kp Kp2; Ki Ki2; Kd Kd2; }6.2 前馈补偿加入速度前馈改善动态响应Pwm PID_Output FeedForward * Target_Speed;6.3 数字滤波对编码器信号进行滑动平均滤波#define FILTER_LEN 5 int Filter_Buffer[FILTER_LEN]; int Moving_Average_Filter(int new_val) { static int index 0; int sum 0; Filter_Buffer[index] new_val; if(index FILTER_LEN) index 0; for(int i0; iFILTER_LEN; i) sum Filter_Buffer[i]; return sum / FILTER_LEN; }