STM32F103上实现模糊自整定增量式PID电机控制

简介本资源是一套面向嵌入式初学者与进阶开发者的STM32F103电机控制实践方案聚焦模糊自整定增量式PID算法在直流编码电机速度闭环控制中的工程实现。针对传统PID响应滞后、抗扰性弱等问题该代码基于正点原子开发规范重构通过模糊逻辑在线调节PID参数显著提升动态响应与稳态精度具备强参考价值与可移植性。压缩包共170个文件含39个头文件.h定义外设接口与控制参数、38个C源文件.c实现TIM/PWM/ENCODER/模糊推理等核心模块辅以编译中间文件.o/.d/.crf及Keil工程配置.uvprojx/.uvoptx、可执行镜像.hex/.axf等完整构建产物总大小4.74MB结构清晰、注释详实、分块明确。目前已有4286人学习下载读者可直接导入Keil MDK复现控制效果深入理解模糊PID的量化设计、中断服务调度、编码器测速与PWM调速协同等关键嵌入式控制要点。1. 为什么在 STM32F103 上不用经典 PID而要上模糊自整定 增量式——这不是炫技是带载突变、供电波动、编码器抖动下的生存刚需某高校课程设计里学生用标准位置式 PID 控制直流编码电机空载调得飞起一挂上小风扇负载转速就掉 15%换电池供电电压从 12.1V 掉到 11.4VPID 参数就得重调一遍更玄学的是同一块板子冬天和夏天跑同一套参数超调量能差一倍。后来他们把控制逻辑换成「模糊自整定 增量式 PID」双层结构没改硬件、没换传感器只动了控制算法层结果负载阶跃响应时间缩短 37%电压扰动下稳态误差从 ±8 RPM 压到 ±2 RPM温漂导致的参数偏移自动补偿了 92%。这套方案不是为发论文堆概念而是给资源受限的 STM32F10372MHz Cortex-M3、20KB RAM塞进一个“会自己调参的 PID 黑匣子”——它不依赖建模不依赖离线辨识靠实时误差 e(k) 和误差变化率 ec(k) 查表修正 Kp、Ki、Kd再用增量式输出避免积分饱和、抗执行器死区、兼容 PWM 占空比跳变。适合所有正在做电机闭环课设、毕设或调试实际机电系统却卡在“一调就振、一稳就慢、一换环境就废”的同学。你不需要懂模糊数学推导但必须清楚每一张查表怎么填、每一个增量计算怎么防溢出、每一处中断优先级怎么卡死。2. 总体架构设计三层嵌套结构与四个核心模块的职责边界这套方案不是把模糊控制和 PID 简单拼在一起而是按实时性、确定性、可维护性做了严格分层。整个控制流跑在 TIM2 更新中断1ms 周期中不依赖 SysTick不抢占 ADC 或 UART 中断确保电机控制主循环的硬实时性。总体分为三层感知层 → 决策层 → 执行层中间穿插一个独立的参数固化模块用于掉电保存。四个核心模块各司其职绝不越界编码器测速模块TIM4 编码器接口纯硬件计数不进中断服务函数做除法只在主循环中读取计数值并用滑动窗口滤波5 点中值 3 点均值输出真实 RPM模糊推理模块RAM 查表 线性插值不运行模糊推理机而是离线生成 7×7 模糊规则表e 和 ec 各 7 级运行时查表 双线性插值得到 ΔKp、ΔKi、ΔKd增量式 PID 运算模块Q15 定点运算全部用 CMSIS-DSP 的 Q15 函数实现避免 float 浮点开销关键变量全程 int16_t防溢出逻辑内嵌PWM 输出与保护模块TIM3 CH2输出占空比前强制限幅0~1000 对应 0%~100%并加入“连续 3 次超调 10% 则降频采样”软保护机制。提示不要把模糊规则表放在 Flash 里——STM32F103 的 Flash 读取有等待周期查表延迟不可控必须放在 SRAM如 0x20000000 起始的 20KB 区域实测查表插值耗时稳定在 8.3μs72MHz 下远低于 1ms 中断间隔。2.1 编码器测速为什么不用定时器门控计数而坚持用编码器接口模式很多同学图省事用 TIMx 门控模式测 M 法转速开闸计数、关闸读数、除以时间。这在低速时误差爆炸——比如电机转速 30RPM0.5Hz1 秒内只产生 12 个脉冲假设 256 线编码器计数值方差极大。而本方案强制使用 TIM4 的编码器接口模式TI1 TI2让硬件自动识别 AB 相正交脉冲方向并累加/递减计数。关键在于不依赖定时器更新中断读取计数器而是在主循环中每 10ms 主动读一次 CNT 值再减去上一次读值得到 Δcnt再代入公式RPM (Δcnt × 60) / (ENC_LINE × Δt)。其中 ENC_LINE 256可配置Δt 0.01s。这样做的好处是避免中断嵌套导致的计数丢失尤其当 TIM2 中断和 TIM4 更新中断同时发生时主循环中可插入滑动窗口滤波维护一个长度为 5 的环形缓冲区每次存入新 Δcnt丢弃最老值取中位数再对中位数序列做 3 点移动平均最终 RPM 波动 ±1 RPM实测 100RPM 工况全程无浮点运算Δcnt 为 int32_tRPM 计算用RPM (int32_t)((int64_t)delta_cnt * 60000) / (256 * 10)实现定点除法避免除零和溢出。2.2 模糊规则表生成离线设计比在线推理更可靠7×7 表怎么填才不翻车模糊自整定的核心不是“有多智能”而是“规则是否贴合物理本质”。我们不用 MATLAB 模糊工具箱生成花里胡哨的隶属度函数而是基于电机控制经验手工定义 e误差和 ec误差变化率的 7 级语言变量NB负大、NM负中、NS负小、ZO零、PS正小、PM正中、PB正大。对应量化论域为 [-6, 6]共 13 个整数点。规则表不是凭空编的而是按经典 Ziegler-Nichols 启发式原则填写e\ecNBNMNSZOPSPMPBNBPBPBPMPMPSZOZONMPBPBPMPSPSZONSNSPMPMPSPSZONSNSZOPMPSPSZONSNMNMPSPSPSZONSNSNMNMPMPSZONSNMNMNMNBPBZOZONSNMNMNBNB这张表的物理含义是当误差大且变化率也大NB/NB说明系统严重滞后必须大幅增加 KpPB来快速纠偏当误差为零但变化率很大ZO/PB说明正冲过头要立刻减小 KpNB防止超调当误差和变化率都接近零ZO/ZO说明已近稳态只微调 KiZO消除静差。查表后得到的 ΔKp、ΔKi、ΔKd 是 7 级整数-3 ~ 3需映射为实际增量。我们设定基准调节步长ΔKp_base 0.05ΔKi_base 0.002ΔKd_base 0.1。最终Kp_new Kp_old ΔKp × ΔKp_base其余同理。注意Kp 初始值设为 0.8经实验验证此值在多数 12V 直流电机上不振荡Ki 初始 0.02Kd 初始 0.05。2.3 增量式 PID 运算为什么必须用 Q15 定点 手动防溢出而不是直接 floatSTM32F103 没有硬件 FPUfloat 运算一条y Kp*e Ki*sum_e Kd*(e - e_last)要 30 个周期而我们的中断周期只有 1ms即 72000 个周期留给 PID 的安全余量不能超过 5000 周期。实测 float 版本在 1ms 中断中占用 4200 周期一旦加入串口打印或 LED 指示立刻丢中断。因此必须用 Q151.15 格式范围 -1.0 ~ 0.99997定点运算。CMSIS-DSP 库提供arm_pid_q15()但它是位置式且内部未做溢出保护。我们手写增量式版本// Q15 增量式 PID 核心计算所有变量为 int16_t int16_t pid_incremental_q15(int16_t e_k, int16_t e_k_1, int16_t sum_e, int16_t Kp_q15, int16_t Ki_q15, int16_t Kd_q15) { int32_t delta_out 0; // Kp * e(k) delta_out (int32_t)Kp_q15 * e_k; // Ki * e(k) —— 注意这里用 e(k) 而非 sum_e因是增量式 delta_out (int32_t)Ki_q15 * e_k; // Kd * (e(k) - e(k-1)) int16_t de e_k - e_k_1; delta_out (int32_t)Kd_q15 * de; // 强制限幅到 Q15 范围-32768 ~ 32767 if (delta_out 32767) delta_out 32767; if (delta_out -32768) delta_out -32768; return (int16_t)delta_out; // 截断为 int16_t }这段代码的关键设计点所有乘法升为 int32_t 防溢出最后再截断Ki * e(k)是增量式的正确写法区别于位置式Ki * sum_e避免积分饱和累积de e_k - e_k_1必须用 int16_t 计算否则高位符号扩展会出错返回值直接用于更新 PWM 占空比无需再做out out_last delta_out因为调用者已维护pwm_duty_last。实测该函数在 72MHz 下仅耗时 1.8μs为整个控制环留足余量。2.4 PWM 输出与保护为什么占空比更新必须加“软保护”而不仅是硬件限幅硬件 PWM 本身有 CCRx 寄存器限幅0 ~ ARR但这只能防爆不能防误动作。我们遇到的真实问题是电机启动瞬间编码器信号未稳定测速模块输出乱码 RPM如 -2000导致 e(k) 极大PID 输出满占空比电机“砰”一声猛撞限位。为此我们在TIM2_Update_IRQHandler中加入两级软保护超调熔断机制维护一个overshoot_counter每次|e(k)| 10% of target_rpm且e(k)*e(k-1) 0即过零超调时计数加 1连续 3 次则触发熔断将当前pwm_duty置为 50050%并暂停模糊自整定 500ms即冻结 Kp/Ki/Kd 更新速率限制机制pwm_duty_new pwm_duty_last clamp(delta_duty, -50, 50)即每 1ms 最多增减 5% 占空比防止突变冲击死区补偿开关当pwm_duty 100时自动开启死区补偿在pwm_duty上叠加 15抵消 MOSFET 驱动延时导致的低占空比无效区。这些保护不增加主循环负担全部在中断中完成判断且状态变量用static修饰保证跨中断一致性。3. 模块实现详解从初始化到中断服务每一行代码都有明确物理意义初始化不是堆函数调用而是按信号流向逐级打通。我们不调用HAL_TIM_Encoder_Start()这类黑盒函数而是手动配置寄存器确保每个位都符合控制需求。以下为关键初始化片段及设计依据。3.1 编码器接口初始化TIM4 的 CCMR1、CCER、SMCR 必须这样配编码器模式本质是把 TI1 和 TI2 作为计数时钟源并用另一个通道判断方向。TIM4 用作编码器必须关闭其更新中断避免干扰主控环只启用计数功能// 1. 使能 TIM4 时钟 RCC-APB1ENR | RCC_APB1ENR_TIM4EN; // 2. 配置 GPIOA_CH1/CH2 为复用推挽PA0TI1, PA1TI2 GPIOA-CRL ~(0xFF 0); // 清除 PA0/PA1 位 GPIOA-CRL | (0xB4 0); // PA0/PA1 AF_PP_50MHz // 3. 配置 TIM4 为编码器模式SMS011编码器模式3CC1S01TI1 映射CC2S01TI2 映射 TIM4-SMCR TIM_SMCR_SMS_1 | TIM_SMCR_SMS_0; // 011 TIM4-CCMR1 TIM_CCMR1_CC1S_0 | TIM_CCMR1_CC2S_0; // CC1S01, CC2S01 TIM4-CCER TIM_CCER_CC1E | TIM_CCER_CC2E; // 使能 TI1/TI2 输入 // 4. 设置预分频器为 0计数器自动清零编码器模式下 ARR 不影响计数 TIM4-PSC 0; TIM4-ARR 0xFFFF; // 溢出值设最大防意外溢出 TIM4-CNT 0; // 清零计数器 // 5. 启动计数器不使能更新中断 TIM4-CR1 TIM_CR1_CEN;这段配置的物理意义SMS011是关键它让 TIM4 的计数方向由 TI1 和 TI2 的相位关系决定AB 相超前为正转滞后为反转CCMR1中CC1S01表示 TI1 作为输入捕获通道 1CC2S01表示 TI2 作为通道 2二者共同构成正交解码CCER中CC1E和CC2E必须同时使能缺一则无法识别方向CR1_CEN单独使能不设URS更新请求源确保 CNT 只由编码器脉冲驱动不受软件更新干扰。注意不要在TIM4_IRQHandler中读取 CNTTIM4 的编码器模式不产生更新中断强行开中断会导致异常。CNT 值只在主循环中读取。3.2 主控定时器 TIM2 初始化1ms 更新中断的精度保障TIM2 是整个控制环的心脏其中断周期必须绝对稳定。我们不用 HAL 的HAL_TIM_Base_Start_IT()而是直操寄存器规避 HAL 层可能引入的额外开销// 1. 使能 TIM2 时钟 RCC-APB1ENR | RCC_APB1ENR_TIM2EN; // 2. 配置 TIM2PSC71, ARR999 → 72MHz/(711)/(9991) 1000Hz 1ms TIM2-PSC 71; // 预分频 72 分频 TIM2-ARR 999; // 自动重装载 1000 计数 TIM2-CNT 0; // 清零 // 3. 开启更新中断仅此中断 TIM2-DIER TIM_DIER_UIE; // 4. 使能中断向量NVIC NVIC_EnableIRQ(TIM2_IRQn); NVIC_SetPriority(TIM2_IRQn, 0); // 最高优先级高于 USART/SysTick // 5. 启动计数器 TIM2-CR1 TIM_CR1_CEN;关键参数解释PSC71 实现 72 分频72MHz → 1MHzARR999 实现 1000 分频1MHz → 1kHz总周期 1msNVIC_SetPriority(TIM2_IRQn, 0)是硬性要求若 TIM2 中断优先级 ≤ ADC 中断则 ADC 采样期间 TIM2 中断被挂起导致控制周期抖动不设置URS1只溢出更新避免任何非计数事件触发更新中断。3.3 模糊查表与插值RAM 中的 7×7 表如何高效加载与访问模糊规则表不是全局数组而是定义在.data段的 const 数组编译时加载到 SRAM// 定义在 .c 文件顶部非头文件避免重复定义 const int8_t fuzzy_kp_table[7][7] { {3, 3, 2, 2, 1, 0, 0}, {3, 3, 2, 1, 1, 0, -1}, {2, 2, 1, 1, 0, -1, -1}, {2, 1, 1, 0, -1, -2, -2}, {1, 1, 0, -1, -1, -2, -2}, {1, 0, -1, -2, -2, -3, -3}, {0, 0, -1, -2, -2, -3, -3} }; // Ki、Kd 表结构相同略查表函数必须支持双线性插值因 e/ec 量化后常落在格点之间int8_t fuzzy_lookup_interp(const int8_t table[7][7], int16_t e_q, int16_t ec_q) { // e_q, ec_q 范围 [-6, 6]映射到 [0, 12]再缩放为浮点 [0.0, 12.0] float e_f (e_q 6.0f) * 1.0f; // 1.0f 是缩放因子保持 13 点对应 0~12 float ec_f (ec_q 6.0f) * 1.0f; // 取整得到左下角索引 int ix (int)e_f; int iy (int)ec_f; if (ix 0) ix 0; if (ix 5) ix 5; // 限幅到 0~57×7 表索引 0~6需 6 个区间 if (iy 0) iy 0; if (iy 5) iy 5; // 四角值 int8_t v00 table[iy][ix]; int8_t v10 table[iy][ix1]; int8_t v01 table[iy1][ix]; int8_t v11 table[iy1][ix1]; // 插值权重 float wx e_f - ix; float wy ec_f - iy; // 双线性插值 float v v00*(1-wx)*(1-wy) v10*wx*(1-wy) v01*(1-wx)*wy v11*wx*wy; // 截断为 int8_t return (int8_t)(v 127 ? 127 : (v -128 ? -128 : v)); }这段代码的工程考量e_f和ec_f用 float 是唯一可接受的浮点操作因插值精度要求高且只在此处出现ix,iy限幅到 0~5确保ix1,iy1不越界插值结果强制截断为 int8_t适配后续 Q15 运算整个函数耗时约 3.2μs含 float 运算仍在安全范围内。3.4 主循环与中断服务为什么主循环只做“读-算-写”而中断只做“采样-触发”这是实时系统设计铁律主循环while(1)负责确定性任务中断负责及时性任务。我们的主循环结构极简int16_t rpm_target 300; // 目标转速可由串口修改 int16_t rpm_actual 0; int16_t pwm_duty 0; int16_t e_last 0, sum_e 0; int main(void) { SystemInit(); gpio_init(); tim4_encoder_init(); // 编码器 tim2_irq_init(); // 主控中断 tim3_pwm_init(); // PWM 输出 while(1) { // 1. 读取当前 RPM调用 2.1 节滤波函数 rpm_actual get_filtered_rpm(); // 2. 计算误差 e(k) 和 ec(k) int16_t e_k rpm_target - rpm_actual; int16_t ec_k e_k - e_last; e_last e_k; // 3. 模糊自整定查表插值 int8_t delta_kp fuzzy_lookup_interp(fuzzy_kp_table, e_k2, ec_k2); int8_t delta_ki fuzzy_lookup_interp(fuzzy_ki_table, e_k2, ec_k2); int8_t delta_kd fuzzy_lookup_interp(fuzzy_kd_table, e_k2, ec_k2); // 4. 更新 PID 参数带限幅 Kp_q15 clamp_q15(Kp_q15 (delta_kp 10), 0x0000, 0x3FFF); // Kp ∈ [0, 4.0) Ki_q15 clamp_q15(Ki_q15 (delta_ki 10), 0x0000, 0x0FFF); // Ki ∈ [0, 1.0) Kd_q15 clamp_q15(Kd_q15 (delta_kd 10), 0x0000, 0x7FFF); // Kd ∈ [0, 8.0) // 5. 增量式 PID 运算 int16_t delta_duty pid_incremental_q15(e_k, e_last_prev, sum_e, Kp_q15, Ki_q15, Kd_q15); pwm_duty clamp_duty(pwm_duty delta_duty); // 6. 更新 PWM 占空比直接写 CCR2 TIM3-CCR2 pwm_duty; // 7. 10ms 周期任务如串口发送 RPM if (tick_10ms) { send_rpm_to_pc(rpm_actual, rpm_target, pwm_duty); tick_10ms 0; } delay_us(100); // 主循环最小延时防 CPU 空转 } }而TIM2_IRQHandler极其轻量extern volatile uint8_t tick_10ms; uint16_t tick_count 0; void TIM2_IRQHandler(void) { if (TIM2-SR TIM_SR_UIF) { TIM2-SR ~TIM_SR_UIF; // 清中断标志 tick_count; if (tick_count 10) { tick_count 0; tick_10ms 1; // 主循环中处理 10ms 任务 } } }这种分工的意义主循环中所有计算都是确定性的可预测执行时间实测 120μs中断只做计数和标志置位无任何计算确保中断退出延迟 1μse_last_prev是为 PID 计算准备的上一时刻 e(k)在主循环开头更新避免中断中读写冲突。4. 常见问题排查这 4 个坑90% 的人第一次调试都会踩这套方案在某高校实验室被 32 名学生复现统计显示以下 4 个问题出现频率最高且一旦踩中调试时间往往超过 20 小时。我把现象、根因、解决步骤拆解到原子级照着做就能过。4.1 现象电机完全不动或只“咔哒”一下PWM 引脚测不到波形原因TIM3 的 PWM 输出通道未正确映射到物理引脚或 GPIO 复用功能未使能。排查步骤查原理图确认 PWM 输出引脚本方案默认 PA7 → TIM3_CH2检查RCC-APB1ENR是否置位RCC_APB1ENR_TIM3EN漏开 TIM3 时钟寄存器全为 0检查GPIOA-AFR[1]的 bit28~31PA7 的复用功能寄存器必须为0b0010AF2对应 TIM3_CH2检查TIM3-CCMR1的CC2S位bit8~9必须为0b01通道 2 为输出模式用万用表测 PA7 对地电压应为 3.3V说明 GPIO 配置成功再测TIM3-CCR2值是否随pwm_duty变化若不变说明主循环未执行或pwm_duty未更新。血泪经验某同学把AFR[1]写成AFR[0]PA7 一直输出高电平MOSFET 始终导通电机堵转冒烟——务必用示波器看 PA7 波形而非只测电压。4.2 现象电机转速忽高忽低RPM 曲线呈锯齿状幅度达 ±50RPM原因编码器测速未做滤波或 TIM4 计数器被意外清零。排查步骤在主循环中添加printf(CNT%d\n, TIM4-CNT)观察 CNT 值是否连续增长正转时或连续减小反转时若频繁跳变如 100→0→200说明 TIM4 被软件清零或硬件干扰检查是否在别处调用了TIM4-CNT 0常见于错误复制的 HAL 代码检查get_filtered_rpm()函数中滑动窗口是否正确实现环形缓冲区索引idx (idx 1) % 5且idx为static变量用示波器测编码器 A 相波形确认边沿干净无毛刺若毛刺多需在硬件上加 100nF 电容滤波。避坑提示不要用HAL_TIM_ReadCapturedValue(htim4, TIM_CHANNEL_1)读编码器值——这是为输入捕获设计的对编码器模式返回无效值。4.3 现象模糊自整定后 Kp 越调越大电机振荡加剧最终停转原因模糊规则表中 ΔKp 的符号与物理方向相反或 e/ec 量化方向弄反。排查步骤在主循环中添加printf(e%d, ec%d, delta_kp%d\n, e_k, ec_k, delta_kp)用手缓慢转动电机观察 e 和 ec 符号当 RPM target 时 e0转速在上升时 ec0查fuzzy_kp_table[3][3]eZO, ecZO 对应的中心值应为 0不调节若为正数说明规则表整体偏激进检查fuzzy_lookup_interp()中e_q2的右移e_k 范围 [-300, 300]右移 2 位得 [-75, 75]再6后为 [-69, 81]超出 [-6, 6] 论域正确做法是先限幅e_q clamp_int16(e_k, -60, 60)再2得 [-15, 15]再6映射到 [ -9, 21]此时需在查表函数中做二次限幅临时将delta_kp强制设为 0观察 PID 是否稳定——若稳定证明模糊层是问题源。后悔药备份一份fuzzy_kp_table的“保守版”所有值除以 2调试初期先用它。4.4 现象串口收到 RPM 数据但 PC 端显示乱码或数据帧不完整原因串口发送未加临界区保护或send_rpm_to_pc()中sprintf()占用栈空间超限。排查步骤检查USART1_IRQHandler中是否清除了TC发送完成标志位若未清TC会持续触发中断send_rpm_to_pc()必须用__disable_irq()关中断再发因printf类函数可能被中断打断导致缓冲区错乱避免在中断中调用printf所有串口输出必须在主循环中完成若用sprintf(buf, %d,%d,%d\n, rpm_a, rpm_t, pwm)确保buf大小 ≥ 20 字节且buf定义为static char buf[32]避免栈溢出。玄学排查用逻辑分析仪抓 TX 引脚波形看起始位、数据位、停止位是否标准115200bps 下1bit8.7μs若波形畸变检查 MCU 供电是否跌落电机启动时 VDD 从 3.3V 掉到 3.0V。5. 验收与答辩用三张表、一个波形、两次对比让老师当场点头验收不是跑通就行而是要证明你理解了“为什么这么设计”。我带过的 17 个毕设项目答辩通过率 100% 的共同点是不讲原理只展示证据。以下是我在某高校实验室帮 A 同学准备的验收材料包他用这套方法 30 分钟内让老师签了字。5.1 验收必备三张表参数表、性能对比表、故障注入表第一张是基础参数表印在 A4 纸首页让老师一眼抓住关键项目值说明MCUSTM32F103C8T672MHz20KB RAM64KB Flash编码器256 线 AB 相硬件正交解码10ms 采样周期控制周期1msTIM2 更新中断实测抖动 0.2μs模糊论域e, ec ∈ [-6, 6]7 级语言变量查表双线性插值PID 类型增量式 Q15本文还有配套的精品资源点击获取