STM32定时器编码器模式驱动电机精准控制与PID调试

1. 先把需求拆开这套方案到底在解决什么问题手上有一台小功率直流减速电机轴上装了增量式旋转编码器要求做到给定转速就能稳、给定位置就能停。这类需求在自动化设备、小型机械臂、实验平台里非常普遍核心手段就是用STM32 标准库驱动旋转编码器实现电机精准控制——把编码器的 A、B 两相正交信号交给定时器的硬件编码器接口去计数MCU 只负责按固定周期读取计数值、算出转速、走一遍 PID最后把结果写进 PWM 占空比寄存器。听起来只有四步但真正落地时麻烦事全在细节里脉冲数对不上、低速时速度曲线像锯齿、电机一转起来计数就乱跳、PID 调到最后整机嗡嗡响。这些问题不是靠背一份代码就能解决的需要对信号链、定时器行为、采样周期和控制器结构都有清楚的认识。这篇内容面向三类读者一是刚接触 STM32 定时器编码器模式、想搞明白为什么这么配的入门者二是已经能跑通例程、但带载之后发现问题一堆的进阶者三是需要一个可复现的控制框架、打算直接照着搭一套的工程人员。文中所有代码基于标准外设库SPL风格编写芯片以常见的 STM32F1 系列为主其他系列思路一致只是寄存器名和库函数略有差别。我在下面会把每个配置项背后的动机说清楚参数怎么算、坑在哪里、怎么验证都会给到。需要先说清楚一件事这套方案并不是最优解而是性价比最优解。用硬件定时器解码CPU 占用几乎为零成本只有一颗几块钱的 MCU相比外挂专用解码芯片省了 BOM 和布线相比纯软件中断解码抗干扰能力和最高计数频率都高一个档次。理解了它适合什么、不适合什么后面所有取舍才有依据。2. 硬件层从编码器信号到 MCU 引脚这一路2.1 增量式编码器的 AB 相与四倍频到底怎么数出来的增量式编码器输出两路方波 A 和 B相位差 90 度这个相位差就是方向信息的载体。A 超前 B 90 度时正转B 超前 A 90 度时反转。单看一路信号只能知道转了多少看两路才能知道往哪转。所谓倍频指的是在一个完整的电气周期里能采到多少个计数事件。一个周期内 A、B 各有一次上升沿和一次下降沿共四个边沿。如果只对 A 的上升沿计数就是 1 倍频对 A 的双边沿计数是 2 倍频对 A、B 的全部四个边沿都计数就是 4 倍频。STM32 的定时器编码器模式正好对应这几种选TIM_EncoderMode_TI1时只对 TI1 的边沿响应选TIM_EncoderMode_TI12时两路都响应。这里有个容易搞混的点很多人以为TIM_EncoderMode_TI12就是四倍频这话对但要补一句前提——它是对两路信号的所有有效边沿计数。假设编码器标称 1000 线每转 1000 个周期那么四倍频之后每转就是 4000 个计数。这个数字直接决定了后面所有换算的系数写错一位转速就整体偏 4 倍。标称线数还有个坑有些厂商标的是每转脉冲数PPR有些标的是A 相每转脉冲数还有的标分辨率但其实是四倍频后的值。拿到手册别急着算先确认定义。我吃过一次亏按 PPR 算出来的转速比实际高一倍排查了整整一个下午才发现是定义搞错了。选线数的时候有个经验不要盲目追求高线数。线数越高同样转速下脉冲频率越高对定时器输入滤波和布线抗干扰的要求就越苛刻。1000 线配 4 倍频在 3000 rpm 时脉冲频率已经到 200 kHz这个频率下如果线缆没屏蔽好误计数是必然的。一般中小功率场合500 到 1000 线足够需要更高分辨率时优先考虑机械减速比而不是堆编码器线数。2.2 上拉、滤波、屏蔽三个最容易被省掉又最致命的环节编码器输出类型分集电极开路OC、推挽、差分线驱动几种。手头这颗如果是 OC 输出必须加上拉电阻否则信号根本拉不到高电平表现为计数偶尔丢或者干脆不动。上拉阻值一般取 1k 到 4.7k太小了功耗高、边沿变缓太大了上升沿爬升慢高速时会丢脉冲。我通常先用 2.2k 试用示波器看上升沿如果超过 1 微秒就往下调。STM32 的定时器输入通道自带数字滤波通过TIM_ICFilter配置范围 0 到 15本质是对输入信号采样若干次后确认。这个功能非常实用但很多人配置时随手填 0等于把滤波关掉了。在电机 PWM 干扰明显的环境里我一般把滤波器开到 6 到 10 之间代价是引入了几个采样周期的延迟。滤波器时钟来自定时器时钟分频后的采样频率粗略估算如果定时器时钟 72 MHz、CKD 不分频滤波器值 N 对应的确认时间大约是 N 个时钟周期也就是十几个纳秒到一百多纳秒的量级。这个延迟对转速环完全无感但能挡掉大部分毛刺。线缆这块三件事必须做双绞、屏蔽、远离动力线。A、B 两相互相双绞能有效抑制共模干扰屏蔽层单端接地接控制板这一侧不要两头都接两头接容易形成地环路反而引入更多噪声。走线时和电机 PWM 线、电源线分开走实在要交叉就垂直交叉别平行走线。这些是老生常谈但每次出问题回头查八成还是这几条没做到。如果传输距离超过一米或者环境干扰特别强就别硬撑单端信号了换差分输出的编码器接收端加一颗差分接收芯片转成单端再进 MCU。多花十几块钱省掉的是后面几天的排查时间。2.3 地线和电源看不见的那一半问题控制板和电机驱动共地这是常识但共地的方式决定成败。电机启动瞬间电流能到几安培如果电机的地线和编码器的地线走同一根细线地线上的压降会让编码器的参考电平跟着跳动表现出来的现象就是电机一启动计数就乱。正确做法是星型接地电源负极作为一个公共点电机驱动的地、控制板的地、编码器的地分别用独立的线接到这个点不要串成一串。编码器的电源也一样最好单独一路 LDO 供 5V 或 3.3V中间加一颗 100μF 电解加 0.1μF 陶瓷做退耦别从电机驱动的 5V 上直接引。还有一点经常被忽略编码器如果是 5V 供电、输出 5V 电平而 MCU 是 3.3V 系统直接接上去短时间可能没事长时间会损伤输入级的钳位二极管。稳妥的做法是加电平转换或者串联 1k 电阻再配合 MCU 内部的钳位保护前提是信号频率不高。信号频率高的时候串电阻会让边沿变缓那就老老实实上电平转换芯片。我见过不少能跑但偶尔跑飞的案子最后都是这个电平问题。3. 定时器编码器模式把硬件解码真正用起来3.1 编码器模式在硬件里到底做了什么标准库里的TIM_EncoderInterfaceConfig这个函数做的事情是把定时器的输入捕获通道改造成编码器接口TI1 和 TI2 分别接 A、B 两相内部逻辑根据两路电平组合决定 CNT 是加还是减。它本质上是把 CNT 变成了一个由外部脉冲驱动的可逆计数器不需要 CPU 参与也不需要中断。具体行为是这样的当 A、B 的相位关系表示正转时每个有效边沿 CNT 加 1表示反转时 CNT 减 1。方向信息由硬件自动判断不依赖软件判断先后顺序。这点很关键——软件中断解码容易在高速时漏中断导致方向判断错误硬件解码不存在这个问题。配置上有两个参数容易写错。第一个是TIM_ICPolarity它决定哪一路反相。如果发现正转时 CNT 在减有两种改法交换 A、B 的接线或者把其中一路的极性配置改成TIM_ICPolarity_Falling。我倾向于改配置因为改线要动硬件调试阶段来回插拔很烦。第二个是TIM_ICFilter前面说过别填 0。还有一点TIM_ICInit里的TIM_ICSelection在编码器模式下必须选TIM_ICSelection_DirectTI选成 Indirect 会接到内部的另一路上计数行为完全不对。这个细节很多例程里没写清楚照抄容易出错。3.2 一份可直接用的标准库配置下面这段是我常用的配置以 TIM3 为例PA6、PA7 作为编码器输入重映射到 TIM3_CH1、TIM3_CH2#include stm32f10x.h void Encoder_Init(void) { GPIO_InitTypeDef GPIO_InitStructure; TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_ICInitTypeDef TIM_ICInitStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_AFIO, ENABLE); /* PA6 - TIM3_CH1, PA7 - TIM3_CH2 */ GPIO_InitStructure.GPIO_Pin GPIO_Pin_6 | GPIO_Pin_7; GPIO_InitStructure.GPIO_Mode GPIO_Mode_IN_FLOATING; /* 外部已上拉 */ GPIO_InitStructure.GPIO_Speed GPIO_Speed_50MHz; GPIO_Init(GPIOA, GPIO_InitStructure); TIM_TimeBaseStructInit(TIM_TimeBaseStructure); TIM_TimeBaseStructure.TIM_Period 65535; TIM_TimeBaseStructure.TIM_Prescaler 0; TIM_TimeBaseStructure.TIM_ClockDivision TIM_CKD_DIV1; TIM_TimeBaseStructure.TIM_CounterMode TIM_CounterMode_Up; TIM_TimeBaseInit(TIM3, TIM_TimeBaseStructure); TIM_EncoderInterfaceConfig(TIM3, TIM_EncoderMode_TI12, /* 四倍频 */ TIM_ICPolarity_Rising, TIM_ICPolarity_Rising); TIM_ICStructInit(TIM_ICInitStructure); TIM_ICInitStructure.TIM_Channel TIM_Channel_1; TIM_ICInitStructure.TIM_ICFilter 8; /* 数字滤波 */ TIM_ICInit(TIM3, TIM_ICInitStructure); TIM_ICInitStructure.TIM_Channel TIM_Channel_2; TIM_ICInitStructure.TIM_ICFilter 8; TIM_ICInit(TIM3, TIM_ICInitStructure); TIM_SetCounter(TIM3, 0); TIM_Cmd(TIM3, ENABLE); }TIM_Period设 65535 就是让 16 位计数器跑满量程这样不用频繁处理溢出配合后面用int16_t做差值就能自动处理回绕。TIM_Prescaler必须为 0因为这里不需要分频采样分频会影响滤波器的实际采样率。GPIO 模式用浮空输入是因为编码器端已经有上拉如果编码器是 OC 输出而外部没上拉这里就要改成GPIO_Mode_IPU别两边都上拉又互相打架。3.3 16 位计数的回绕处理一个小技巧省掉一堆 if16 位计数器从 0 减 1 会变成 65535从 65535 加 1 会回到 0。如果直接做now - last再去判断正负逻辑会写得很难看还容易出错。干净的做法是把差值强转成有符号 16 位整数int16_t delta; delta (int16_t)(cnt_now - cnt_last); cnt_last cnt_now;这个写法成立的前提是两次采样之间的计数变化量绝对值小于 32768对于正常的采样周期和电机转速这个条件几乎总能满足。举例1000 线编码器四倍频后 4000 计数每转采样周期 10 ms那么要超过 32768 计数需要 8 转每 10 ms也就是 48000 rpm明显超出实际范围。所以这个技巧可以放心用。如果确实遇到高转速场景那就得把TIM_Period设小一点或者在中断里累加溢出次数。但我更推荐换个思路提高采样频率让每次差值更小问题自然消失。注意读 CNT 那一行一定要单独取出来存到变量里不要在多个地方重复调用TIM_GetCounter。两次读取之间计数器可能在变会导致算出来的值和实际用的值不一致表现出来的现象是速度偶尔跳一下极难排查。4. 测速与闭环从脉冲数到转速再到 PWM4.1 M 法、T 法、M-T 法选哪个不是凭感觉测速方法本质上是数脉冲和量时间的两种排列组合方法原理优点缺点适用场合M 法固定时间窗数窗内脉冲数实现简单中高速精度高低速时窗内脉冲太少误差大中高速、对低速精度要求不高T 法固定脉冲数测所需时间低速精度高高速时测量窗口太短低速、极低速M-T 法同时测量脉冲数和时间全速段精度均衡需两路定时器配合实现复杂宽调速范围M 法的相对误差大约是 1/NN 是一个采样周期内的脉冲数。1000 线编码器四倍频10 ms 采样在 100 rpm 时 N 约等于 66误差约 1.5%在 10 rpm 时 N 约等于 6.6误差直接到 15%速度曲线全是锯齿。这就是低速抖动的根源不是 PID 的问题是测量本身的分辨率不够。我的做法是主用 M 法采样周期动态调整。高速时用 10 ms低速时切到 50 ms 甚至 100 ms保证窗内脉冲数不低于某个阈值我一般设 50。切换点要留滞回避免在临界速度附近来回跳。M-T 法精度确实好但它需要用到输入捕获去测时间占用额外通道对于多数中小功率场合动态周期加 M 法已经够用没必要把复杂度提上去。4.2 从计数到转速系数一定要算清楚公式很简单但每一项都要落实到具体数字rpm delta * 60 / (PPR * 4 * i * T)其中delta是采样周期内的计数差PPR是编码器线数4是四倍频系数i是减速比T是采样周期秒。举个具体例子PPR 1000减速比 i 30采样周期 T 0.01 s某个周期内 delta 133。代入算133 × 60 ÷ (1000 × 4 × 30 × 0.01) 7980 ÷ 1200 6.65 rpm。也就是说输出轴转 6.65 转每分钟电机本体是 199.5 rpm。实际代码里为了不让主循环里反复做浮点除法我习惯把这个系数提前算成一个常量#define SPEED_K (60.0f / (1000.0f * 4.0f * 30.0f * 0.01f)) /* 0.05 */ rpm (float)delta * SPEED_K;这个SPEED_K每换一次硬件就要重算一次我一般写在宏里并在注释中标明各参数来源避免过几个月自己都忘了这个数字是怎么来的。工程上见过太多魔数埋雷改一个减速比整机速度全错查半天才发现是系数没更新。还有一点算出来的rpm建议再做一次一阶低通滤波filtered filtered * 0.7f rpm * 0.3f能明显改善速度反馈的平滑度。系数别取太小否则引入的相位滞后会让 PID 更容易振荡。0.2 到 0.4 之间通常比较合适具体看采样周期。4.3 增量式 PID为什么我选它而不是位置式电机速度环用增量式 PID 有几个现实好处输出的是占空比增量天然带限幅不会出现积分饱和后长时间退不出来的情况不需要保存历史误差的累加和切换模式时不会残留代码里只有三次误差参与运算中断里跑也不心疼。实现如下typedef struct { float Kp, Ki, Kd; float err_prev1, err_prev2; float out; float out_max, out_min; } PID_Inc_t; float PID_Inc_Calc(PID_Inc_t *p, float target, float actual) { float err target - actual; float d_out; d_out p-Kp * (err - p-err_prev1); d_out p-Ki * err; d_out p-Kd * (err - 2.0f * p-err_prev1 p-err_prev2); p-err_prev2 p-err_prev1; p-err_prev1 err; p-out d_out; if (p-out p-out_max) p-out p-out_max; if (p-out p-out_min) p-out p-out_min; return p-out; }out_max和out_min对应 PWM 占空比的上下限。上限一般是满占空比但建议留一点余量比如 95%给调节留空间下限则要结合电机启动死区来定很多小电机占空比低于 15% 根本不转如果下限设成 0PID 在小误差时会一直给很低的占空比电机不动误差不减小积分项一路累积等积累够了突然窜出去这就是典型的低速爬行然后猛冲。我的做法是把启动死区作为前馈直接加进去占空比 PID 输出 死区补偿其中死区补偿在目标速度非零时给一个固定值比如 18%目标为零时直接给 0。这样 PID 只需要负责微调不用负责克服死区参数好调很多低速表现也稳。4.4 速度环和位置环怎么串如果只需要稳速单速度环足够。如果需要定位转到指定角度停住就得上串级外环位置、内环速度位置环的输出作为速度环的给定。串级的核心原则是内环必须比外环快一般内环带宽是外环的 5 到 10 倍。具体到代码里就是速度环 10 ms 执行一次位置环 50 到 100 ms 执行一次。位置环的 Kp 不能大因为它的输出是转速给定给大了会让电机猛冲然后过冲回来反复震荡。位置反馈直接用累计计数int32_t pos_total; /* 全局累计位置单位四倍频后的计数 */ void Update_Position(void) { static uint16_t cnt_last 0; uint16_t cnt_now TIM_GetCounter(TIM3); pos_total (int16_t)(cnt_now - cnt_last); cnt_last cnt_now; }pos_total用 32 位有符号整数按 4000 计数每转、减速比 30 算一转换算成 120000 计数32 位能表示约 17000 转对于大多数场合够用。真要超长行程就再加一层圈数计数。定位到位后有个细节停止时要不要锁死。如果只是关掉 PWM电机在负载或惯性下会继续滑一点。我的处理是到位后保持一个小占空比等于死区补偿值并维持一小段时间再完全关断同时靠机械抱闸或者电机的齿槽力矩维持。这个保持段的时长要根据负载惯量试出来惯量越大时间越长。5. 实操复盘从空转到带载的完整调试路径5.1 上电自检先证明计数是对的再谈控制我现在的习惯是任何一套新的编码器方案第一版代码只做一件事把 CNT 值通过串口打出来人手动转轴看数字变化。验证标准有三条正转时数值单调增加反转时单调减少转一整圈数值变化量等于 PPR × 4 × 减速比如果编码器装在电机轴上快速来回转不出现跳变。第三条最容易出问题。手动慢转正常、快转就乱八成是滤波不够或者线太长正转增加但一圈下来数值对不上八成是倍频模式选错或者 PPR 定义搞错数值偶尔往回跳一格八成是干扰或者上拉不足。这一步花半小时能省掉后面几天的困惑。跳过这一步直接上 PID出问题时你根本分不清是测量错了还是控制错了。还有一个上电瞬间的细节TIM_SetCounter(TIM3, 0)之后如果编码器正好停在一个边沿附近第一次读到的值可能是 0 也可能是 ±1这是正常的不用管。但如果每次上电误差都很大那就要检查是不是上电时序问题——编码器电源还没稳MCU 已经开始计数了。5.2 PID 整定的实际步骤别信一步到位的说法我的整定顺序是固定的先 P 后 I 再 D每次只动一个参数。第一步Ki 和 Kd 置零Kp 从很小开始比如 0.5给一个阶跃给定0 到 300 rpm看响应。如果响应很慢、稳态误差大加大 Kp如果开始振荡回退到振荡临界值的 60% 左右。第二步加 Ki。Ki 的作用是消除稳态误差。从小往大加直到稳态误差在可接受范围内消失。注意 Ki 加多了会引入低频振荡表现是速度围绕给定值缓慢地上下摆动周期通常在一秒以上。看到这种慢摆就是 Ki 大了。第三步加 Kd。速度环里 Kd 其实用得不多因为速度反馈本身有噪声微分会把噪声放大。如果确实需要抑制超调Kd 从很小的值开始0.05 量级加的时候注意听电机声音出现高频尖锐啸叫就是 Kd 过大。一个实测的经验值供参考1000 线编码器、减速比 30、10 ms 采样、PWM 20 kHz、目标 300 rpm参数初始值调整后说明Kp0.53.2再大会出现约 8 Hz 振荡Ki00.15消除约 4% 的稳态误差Kd00.02抑制启动超调再大会啸叫死区补偿018%低于此值电机不转不同电机差异很大这组数只能作为起点不能照抄。判断标准就一条给阶跃后响应快、超调小10% 以内、稳态平稳无静差就算调好了。5.3 带载之后才会暴露的三个问题空载调好的参数装上负载大概率要重调。我遇到过三种典型情况。第一种是启动时电流冲击导致复位。电机启动瞬间电流大电源被拉低MCU 复位。解决办法是电源加大电容、PWM 加软启动占空比在 200 ms 内从 0 爬到目标值别一上来就给满。第二是负载突变时的过冲。空载时 PID 输出变化很小带上负载后需要更大的输出范围原来的限幅可能不够表现出来就是负载一加速度掉下去回不来。这时候要检查out_max是不是设得太保守以及死区补偿是否足够。第三是机械共振。某些转速下整机嗡嗡响速度波动明显。这是机械结构和控制环相互作用的结果光调 PID 治不好。可以试着改变采样周期比如从 10 ms 改成 8 ms或者加一个陷波滤波把共振频率点压掉。实在不行就绕开那个转速区间在控制逻辑里设一个禁区。6. 常见问题与排查速查表6.1 计数类问题不增、乱跳、方向反完全不计数先查三件事定时器时钟使能了没有、GPIO 复用功能开了没有、编码器有没有供电。这三条都对再拿示波器看 A、B 相有没有波形。有波形但 CNT 不动多半是通道映射错了查数据手册的复用功能表。计数但数值乱跳按可能性排序滤波没开最常见、上拉不足、线缆没屏蔽、电机干扰。排查方法是先把手动转电机断电测一遍正常说明是干扰问题手动转也乱说明是硬件连接问题。正转数值减小两种改法前面说过改极性配置或者换线改配置更方便。一圈数值对不上先确认 PPR 定义再确认倍频模式。有个快速验证法把TIM_EncoderMode改成TIM_EncoderMode_TI1如果一圈数值变成原来的四分之一说明原来确实是四倍频那问题就在 PPR 参数上。6.2 控制类问题抖动、爬行、过冲、啸叫现象可能原因排查与处理低速时速度曲线锯齿明显M 法分辨率不足加长采样周期或低速段切 M-T 法电机低速不转然后突然猛冲启动死区未补偿积分累积加固定死区前馈PID 只做微调稳态速度小幅慢摆周期 1 s 以上Ki 过大减小 Ki速度高频抖动、电机啸叫Kd 过大或反馈噪声大减小 Kd加反馈低通滤波阶跃响应超调大Kp 过大或缺少微分减小 Kp谨慎加 Kd负载一加速度掉下去回不来输出限幅不够放宽out_max检查死区补偿换向时计数突变换向瞬间抖动边沿密集加输入滤波机械上加阻尼运行一段时间后位置漂移累计溢出或丢脉冲检查pos_total类型查干扰6.3 几条不写在手册里的实操心得心得一中断里不要读 CNT 做复杂运算。编码器模式本身不需要中断读 CNT 完全可以放在定时器中断或者主循环里按固定节拍做。把浮点乘除、PID 运算全塞进高频中断CPU 会被拖垮而且中断里做浮点运算还会涉及上下文保存容易出玄学问题。我的做法是定时器中断只做读计数、更新位置、置标志位PID 和换算放在主循环里跑实测 1 kHz 的节拍下毫无压力。心得二给 PWM 和编码器采样留出相位关系。PWM 开关瞬间干扰最大如果采样时刻正好落在开关沿附近读到的计数可能受干扰。虽然编码器是硬件计数受影响的概率不高但模拟量采样比如电流一定会受影响。工程上的做法是把 ADC 采样触发对齐到 PWM 中心避开开关沿编码器读取也放在同一时刻整体噪声最小。心得三一定要做参数持久化。调好的 PID 参数存在 Flash 里上电读出来。不然每次改一个数都要重新编译下载调试效率低到崩溃。用标准库的 Flash 操作注意擦除页大小和写保护参数区单独划一页别和程序混在一起。心得四加一个看门狗式的保护。如果连续 N 个周期检测到速度反馈为零但 PWM 输出大于某个阈值说明编码器断了或者电机堵转这时候应该立即关断输出并报错。这个小逻辑救过我一次编码器线被扯断如果没这个保护PID 会一路把占空比顶到最大电机烧了都不知道。心得五示波器比打印更靠谱。调控制环的时候串口打印的数据会受波特率限制看不到细节。有条件的话用 DAC 或者 PWM 输出把速度和给定打出来接示波器看波形超调、振荡、延迟一眼就能看出来。没有 DAC 的话用一个 GPIO 在被控量过阈值时翻转也能看出响应时间。我个人在实际操作中的体会是这套方案的难点从来不在代码代码总共不到两百行写完之后几乎不用改。真正花时间的是硬件那一层——线怎么走、地怎么接、滤波器开多大、死区补偿给多少。这些参数没有通用值只能一台上位机、一根线地试出来。所以每次开始新项目我都会把手动转轴验证计数这一步单独安排半天宁可前面慢一点也别在后面被玄学问题拖住。