STM32上基于M法的增量式编码器测速实现

AB相增量式编码器以及STM32定时器编码器模式测速/测距离(HAL库) 编码器(Encoder)是一种用于测量旋转运动或位置的设备。编码器通常与定时器模块一起使用,以便在微控制器中获取和计算旋转的脉冲数量,从而确定物体的运动方向和距离。编码器在许多应用中都很有用,例如机器人运动控制、电机位置反馈和位置传感。STM32微控制器提供了多种类型的编码器支持,其中一种常见的编码器类型是增量编码器。增量编码器基于两个脉冲信号通道,通常称为A相和B相。当旋转发生时,这两个信号通道的相位关系会发生变化,从而可以计算出旋转方向和旋转的步数。 阅读详情

1. 编码器测速原理与M法工程实现

在永磁同步电机(PMSM)的磁场定向控制(FOC)系统中,精确、实时的速度反馈是实现高性能闭环控制的基础。当采用ABZ三相增量式编码器作为位置传感器时,速度信息并非直接输出,而是需要通过软件算法从周期性变化的脉冲序列中提取。工程实践中,主流的测速方法主要有两类:M法(频率测量法)和T法(周期测量法)。二者本质不同,适用场景各异,必须根据电机运行工况、控制器资源约束及精度要求进行权衡。

M法的核心思想是在一个固定的采样时间窗口 $ T_s $ 内,统计编码器输出的脉冲个数 $ N $,再通过公式 $ n = \frac{N \times 60}{P \times T_s} $ 计算转速 $ n $(单位:r/min),其中 $ P $ 为电机每转产生的总脉冲数(即编码器线数乘以4,因A/B相正交解码可实现四倍频)。该方法将速度计算问题转化为一个简单的计数与时钟测量问题,其硬件依赖低、算法开销小、实现稳定,非常适合于中高速运行区间(例如 > 50 r/min)的常规工业应用。

T法则反其道而行之:它不固定时间窗口,而是精确测量相邻两个脉冲沿(通常为A相上升沿)之间的时间间隔 $ \Delta t $,再通过 $ n = \frac{60}{P \times \Delta t} $ 得到瞬时速度。此方法在极低速(甚至堵转)时具有天然优势,理论上可分辨零速附近的微小位移。然而,其代价是中断频率随转速升高而急剧增加。当电机以3000 r/min运行,且编码器线数为1024线时,四倍频后脉冲频率高达204.8 kHz,意味着CPU需每4.88 µs响应一次中断——这不仅会严重挤占主控资源,还极易因中断嵌套或响应延迟导致计时误差累积,最终使测速结果失真。因此,在资源受限的MCU平台上,T法通常仅作为M法的补充,在检测到速度低于某一阈值(如10 r/min)时动态切换,而非全程启用。

本章聚焦于M法的完整工程实现,目标是在STM32F4系列控制器上,基于ABZ编码器硬件接口,构建一个高鲁棒性、低资源占用、可无缝集成至FOC主循环的速度观测器。整个方案不依赖任何高级数学库或浮点运算单元(FPU),全部采用定点整数运算,确保在任意主频下均能稳定运行。

2. 硬件配置与定时器选型分析

M法测速的基石是一个高精度、低抖动的采样时钟源。该时钟必须满足两个核心要求:一是周期严格恒定,不受CPU负载波动影响;二是中断服务程序(ISR)执行时间必须远小于采样周期,以避免因ISR执行过长而导致后续中断被延迟甚至丢失。

在STM32F4系列中,通用定时器(TIM2-TIM5, TIM9-TIM14)和基本定时器(TIM6/TIM7)均可承担此任务。但二者存在关键差异:通用定时器具备输入捕获、输出比较、PWM生成等丰富功能,其寄存器结构复杂,时钟树路径长,且常被用于电机控制中的PWM死区生成、ADC触发等关键任务,资源竞争激烈;而基本定时器(TIM6/TIM7)结构极其精简,仅包含一个16位自动重装载计数器(ARR)、一个16位预分频器(PSC)以及一个更新事件(UEV)中断,无任何I/O引脚关联,纯粹作为“滴答”发生器使用。其时钟路径最短,功耗最低,且因其功能单一,被其他外设抢占的风险为零,是M法采样定时器的理想选择。

本工程选用TIM6作为速度采样定时器。其时钟源来自APB1总线,最大频率为42 MHz(在HCLK=168 MHz、APB1 Prescaler=4的典型配置下)。为获得1 ms的精确采样周期,需进行如下计算:

$$
\text{TIM6_CLK} = 42~\text{MHz} \
\text{所需计数周期} = 42~\text{MHz} \times 1~\text{ms} = 42000 \
\text{预分频系数 } (PSC) = 169 \quad (\text{即分频比为 } 170) \
\text{重装载值 } (ARR) = \left\lfloor \frac{42000}{170} \right\rfloor - 1 = 246
$$

然而,字幕中给出的参数为PSC=169、ARR=999。这表明其实际使用的TIM6时钟源并非标准的APB1,而是经过了额外的倍频。查阅STM32F4xx参考手册可知,TIM6的时钟源可由RCC_CFGR寄存器中的 TIMPRE 位配置:当 TIMPRE=0 时,APB1定时器时钟为APB1总线时钟(42 MHz);当 TIMPRE=1 时,APB1定时器时钟被倍频至2倍APB1总线时钟(84 MHz)。若采用后者,则:

$$
\text{TIM6_CLK} = 84~\text{MHz} \
\text{计数周期} = 84~\text{MHz} \times 1~\text{ms} = 84000 \
\text{PSC} = 169 \Rightarrow \text{分频比} = 170 \
\text{ARR} = \frac{84000}{170} - 1 = 494 - 1 = 493
$$

此结果仍与字幕中的999不符。进一步推断,字幕中提及的“定时器6的总限频率170兆”实为口误,应为“系统时钟(SYSCLK)为170 MHz”。在STM32F407中,最高SYSCLK为168 MHz,170 MHz是常见笔误。假设SYSCLK=168 MHz,APB1 Prescaler=4,则APB1=42 MHz;若 TIMPRE=1 ,则TIM6_CLK=84 MHz。此时,要得到1 ms周期,需:

$$
\text{计数值} = 84~\text{MHz} \times 1~\text{ms} = 84000 \
\text{若 } PSC = 169 \text{(分频170)}, \text{ 则 } ARR = \frac{84000}{170} - 1 = 493
$$

但字幕明确给出ARR=999,这意味着其实际分频比为:

$$
\text{总分频比} = (PSC + 1) \times (ARR + 1) = 170 \times 1000 = 170000 \
\text{因此,TIM6_CLK} = \frac{170000}{1~\text{ms}} = 170~\text{MHz}
$$

这恰好与字幕中“170兆”的表述吻合。由此可确定,该工程配置了TIM6的时钟源为170 MHz,这通常是通过将PLL主时钟(PLLCLK)直接馈送给TIM6实现的,绕过了APB1总线分频器。这是一种非标准但完全可行的配置,其目的在于获得更高的计数分辨率,从而在相同采样周期内获得更精细的计数能力,为后续的滤波和精度提升预留空间。

完成寄存器配置后,必须在RCC时钟使能寄存器(RCC_APB1ENR)中置位 TIM6EN 位,以开启TIM6的时钟供应。随后,在NVIC中配置TIM6更新中断(IRQn_Type: TIM6_DAC_IRQn)的优先级,并使能该中断。最后,通过设置 TIM6->CR1 寄存器的 CEN 位启动计数器。至此,一个精确的1 ms“心跳”便已建立,为M法测速提供了可靠的时序基准。

3. 编码器状态读取与方向判定

ABZ编码器的A、B两相信号呈90度相位差,Z相信号每转发出一个脉冲,用作机械零位参考。在STM32上,通常利用定时器的编码器接口模式(Encoder Interface Mode)来硬件解码A/B相,该模式能自动完成四倍频计数与方向识别,极大减轻CPU负担。然而,对于仅需速度反馈的应用,直接使用GPIO输入捕获亦是可行方案,本工程即采用后者,以展示底层逻辑。

编码器信号接入GPIO端口(例如GPIOA的Pin8、Pin9、Pin10分别对应A、B、Z相),需配置为上拉输入模式,以确保信号悬空时的电平稳定。关键在于如何从A、B相的当前电平组合中推导出旋转方向。一个标准的正交编码器真值表如下:

A (当前) B (当前) A (前一周期) B (前一周期) 方向
0 0 1 0 正转
0 1 0 0 正转
1 0 0 1 正转
1 1 1 0 正转
0 0 0 1 反转
0 1 1 1 反转
1 0 1 1 反转
1 1 0 0 反转

一种高效的软件实现方式是维护一个2位的状态寄存器 state ,其值为 (A << 1) | B 。每次读取新的A/B电平时,计算状态转移: transition = (state << 2) | new_state ,其中 new_state 是新的 (A << 1) | B 值。 transition 的4位值唯一对应一个方向变化。例如,若 transition 为 0b0001 (0→1),则为正转;若为 0b0010 (0→2),则为反转。此方法只需一次查表即可得出方向,效率极高。

在本工程中,方向判定被封装在一个独立函数中,其输入为当前A/B电平,输出为一个有符号的增量值 +1 (正转)或 -1 (反转)。该函数的返回值将直接用于后续的位置差值计算,是连接硬件信号与软件算法的关键桥梁。

4. Z相脉冲累计与多圈计数管理

Z相脉冲是实现“多圈”计数的核心。单圈编码器的计数范围是有限的(例如0-4095),当电机连续旋转多圈时,仅靠A/B相计数器无法区分是单圈内的4095→0跳变,还是跨圈的4095→4096递增。Z相脉冲在此扮演了“进位”信号的角色:每当电机完成一整圈旋转,Z相便产生一个脉冲,软件据此对一个全局的“圈数计数器”进行加减操作。

在STM32中,Z相通常被配置为外部中断(EXTI)输入。当中断触发时,其服务函数(例如 EXTI15_10_IRQHandler )会立即响应。在该函数中,首要任务是清除中断挂起位( EXTI->PR ),然后根据当前的方向判定结果,对一个静态全局变量 z_count 进行原子性增减。 z_count 的数据类型必须足够大(如 int32_t ),以防止在长时间运行后发生溢出。

然而,仅靠Z相计数还不够。因为Z相脉冲宽度很窄,且在电机启动/停止瞬间可能存在抖动,直接在中断中进行复杂的算术运算是危险的。更稳健的做法是:Z相中断服务函数只做最轻量级的工作——仅对一个标志位(如 volatile uint8_t z_flag )进行置位,并立即退出。真正的Z相处理逻辑则被推迟到主循环或一个低优先级的任务中执行。但在M法测速的上下文中,由于所有计算都发生在1 ms的定时器中断中,且Z相中断的频率远低于定时器中断(一圈一次,而定时器是每毫秒一次),因此可以在Z相中断中安全地更新 z_count ,前提是确保该变量的访问是原子的(对于32位变量,在Cortex-M4上对齐访问通常是原子的)。

本工程采用了更简洁的方案:Z相中断函数中,直接读取方向判定函数的返回值( +1 或 -1 ),并据此对 z_count 进行累加。这样, z_count 的值就代表了自系统上电以来,电机所旋转的完整圈数。当需要计算绝对位置时,只需将当前A/B相计数器的值( cnt_ab )与 z_count * P 相加即可,其中 P 是单圈脉冲数(4096)。

5. M法测速核心算法详解

M法测速函数 GetMotorSpeed() 的核心逻辑是一个典型的“差分-积分”过程,其输入是两次采样时刻的编码器状态,输出是当前转速。该函数必须在TIM6的1 ms更新中断中被调用,以保证采样周期的严格一致性。

函数内部维护着三个关键的静态变量:
- last_cnt_ab : 上一次采样时刻的A/B相计数器原始值(0-4095)。
- last_z_count : 上一次采样时刻的Z相累计圈数。
- last_speed : 上一次计算出的转速(r/min),用于提供初始值或作为滤波参考。

算法执行步骤如下:

第一步:读取当前状态
调用底层函数 ReadEncoderState() ,该函数同时完成三项工作:1) 读取GPIOA的Pin8/Pin9电平,计算出当前A/B相计数器值 cnt_ab ;2) 调用方向判定函数,得到 dir (+1或-1);3) 读取全局变量 z_count 。这三者必须在同一时间点获取,以避免因异步读取导致的状态不一致。因此, ReadEncoderState() 函数内部应禁用全局中断( __disable_irq() ),完成所有读取后再恢复( __enable_irq() ),确保原子性。

第二步:计算净脉冲增量
这是整个算法中最精妙的部分,旨在正确处理A/B相计数器的自然溢出。 cnt_ab 是一个12位计数器,其值域为[0, 4095]。当电机正转,且上一周期 last_cnt_ab = 4090 ,本周期 cnt_ab = 5 时,若简单相减 5 - 4090 = -4085 ,结果显然错误。正确的增量应为 5 + 4096 - 4090 = 11 。同理,反转时若 last_cnt_ab = 5 , cnt_ab = 4090 ,则增量为 4090 - 4096 - 5 = -11 。

通用公式为:
$$
\Delta cnt_{ab} =
\begin{cases}
cnt_{ab} - last_cnt_{ab}, & \text{if } |cnt_{ab} - last_cnt_{ab}| \leq \frac{P}{2} \
cnt_{ab} + P - last_cnt_{ab}, & \text{if } cnt_{ab} < last_cnt_{ab} \text{ and } (last_cnt_{ab} - cnt_{ab}) > \frac{P}{2} \
cnt_{ab} - P - last_cnt_{ab}, & \text{if } cnt_{ab} > last_cnt_{ab} \text{ and } (cnt_{ab} - last_cnt_{ab}) > \frac{P}{2}
\end{cases}
$$

其中 $ P = 4096 $。该公式本质上是将12位无符号数的减法,转换为带符号的12位补码减法,利用了模运算的特性。

第三步:合并Z相增量
将A/B相的增量与Z相的增量合并,得到总的净脉冲数 total_delta :
$$
total_delta = \Delta cnt_{ab} + (z_count - last_z_count) \times P
$$
由于 z_count 和 last_z_count 都是整数,且Z相中断频率极低, z_count - last_z_count 的值通常为0、+1或-1,因此此项计算开销极小。

第四步:计算转速
将 total_delta 代入M法公式:
$$
n = \frac{total_delta \times 60}{P \times T_s}
$$
其中 $ T_s = 0.001 $ 秒(1 ms)。为避免浮点运算,可将其改写为定点整数运算:
$$
n = \frac{total_delta \times 60000}{P}
$$
因为 $ \frac{60}{0.001} = 60000 $。若 P = 4096 ,则 n = total_delta * 60000 / 4096 。此除法可通过右移12位( >> 12 )加一个修正项来近似,但为保证精度,工程中通常直接使用32位整数除法。考虑到 total_delta 在1 ms内最大约为 4096 * (1000/1000) = 4096 (对应1 r/ms = 60000 r/min), total_delta * 60000 的最大值约为 245.76e6 ,仍在32位有符号整数范围内( 2^31-1 ≈ 2.15e9 ),因此该计算是安全的。

第五步:状态更新与返回
将本次读取的 cnt_ab 、 z_count 分别赋值给 last_cnt_ab 和 last_z_count ,为下一次采样做好准备。最后,返回计算出的 n 值。整个函数执行时间应控制在几十微秒以内,以确保不会影响TIM6中断的实时性。

6. 抗干扰与鲁棒性设计

在真实的电机驱动环境中,编码器信号极易受到电磁干扰(EMI)、电源噪声和机械振动的影响,导致A/B/Z相出现毛刺。这些毛刺若被误认为有效边沿,将直接污染计数结果,造成速度跳变甚至失控。因此,一套完善的抗干扰策略是M法测速工程化的必要组成部分。

硬件滤波 是第一道防线。在编码器信号接入MCU GPIO之前,应在PCB上为每根信号线添加RC低通滤波器。典型的参数为:串联一个100 Ω电阻,对地并联一个10 nF电容,截止频率约为160 kHz。此设计既能有效滤除高频噪声(>1 MHz),又不会过度衰减编码器的有效信号(对于1000线编码器,3000 r/min时最高信号频率仅为50 kHz)。

软件消抖 是第二道防线。Z相脉冲尤其脆弱,因其宽度可能仅有几微秒。在Z相中断服务函数中,不能一触即发,而应加入一个简单的“确认”机制:当中断触发时,先延时(例如10 µs),再重新读取Z相电平,只有当电平在延时后依然保持有效,才认定为真实脉冲。此延时可通过NOP指令或SysTick计数器实现,必须确保其时间远小于Z相脉冲的最小宽度,但又足以滤除大部分毛刺。

速度滤波 是最后一道防线,也是最重要的。原始的M法计算结果 n 是一个离散的、带有量化噪声的序列。直接将其用于FOC的速度环,会导致电流环剧烈震荡。因此,在 GetMotorSpeed() 函数返回后,必须对其进行数字滤波。最常用且有效的方案是二阶巴特沃斯低通滤波器(Butterworth LPF),其离散化后的差分方程为:
$$
y[n] = b_0 x[n] + b_1 x[n-1] + b_2 x[n-2] - a_1 y[n-1] - a_2 y[n-2]
$$
其中 x[n] 是原始速度, y[n] 是滤波后速度。滤波器的3 dB截止频率应根据电机的机械时间常数设定,通常为10-50 Hz。一个经验法则是:截止频率应为期望速度环带宽的1/5至1/10。滤波器系数 b0, b1, b2, a1, a2 可通过MATLAB的 butter 函数或在线滤波器设计工具生成,并以Q15或Q31定点格式存储,以避免浮点运算。

此外,还应加入 超限保护 逻辑。若计算出的 n 绝对值超过一个物理上不可能的阈值(例如 |n| > 100000 r/min ),则应将其钳位为上一次的有效值,并置位一个错误标志。这能有效防止因编码器脱落、接线错误等极端故障导致的控制系统崩溃。

7. 实时调试与性能验证

算法的正确性最终必须通过实验验证。在STM32平台上,最便捷的实时调试手段是利用ST-Link的SWO(Serial Wire Output)通道,配合 ITM_SendChar() 函数,将速度值以printf风格输出到调试器的Console窗口。然而,频繁的ITM输出本身会引入显著的延迟,影响实时性。因此,更专业的做法是使用“数据跟踪”(Data Trace)功能。

在STM32CubeIDE中,可配置一个“Trace”探针,将 GetMotorSpeed() 函数的返回值 n 作为一个“Trace Variable”进行实时采集。调试器会以极高的采样率(可达数MHz)捕获该变量的变化,并在“SWV ITM Data Console”或“Graph”视图中显示。通过观察图形,可以直观地判断:
- 速度曲线是否平滑,是否存在因Z相误触发导致的阶梯状跳变;
- 在电机启动/停止瞬间,速度是否能快速、无超调地跟随;
- 当施加阶跃转矩时,速度响应是否符合预期的二阶系统特性。

另一种强大的验证方法是使用逻辑分析仪(Logic Analyzer)。将TIM6的更新中断信号(可通过一个GPIO引脚在ISR入口处置高、出口处置低来模拟)与编码器的A相、Z相信号一同接入。通过观察三者之间的时序关系,可以精确验证:
- TIM6中断是否严格以1 ms周期发生;
- Z相脉冲是否确实出现在A相的特定相位点(例如A相高电平期间);
- A相脉冲的频率是否与计算出的速度值严格匹配( f_A = n * P / 60 )。

在本工程的在线仿真(如使用J-Link或ST-Link进行SWD调试)中,通过串口(USART)将速度值发送至上位机(如Tera Term或自定义的Python GUI),是最直观的验证方式。当增大FOC算法中的q轴电压指令 Uq 时,电机加速,上位机接收到的速度值应随之线性增大;当 Uq 为负时,速度值应变为负数,表示反转。这种一一对应的因果关系,是算法正确运行的最有力证明。

8. 与FOC主循环的集成

M法测速模块的最终价值,在于为FOC的外环——速度环(Speed Loop)提供高质量的反馈信号。在典型的FOC架构中,主控制循环(通常由一个高优先级的Systick中断或一个FreeRTOS任务驱动)的执行流程如下:

  1. ADC采样 :触发ADC对电机三相电流进行同步采样。
  2. Clark/Park变换 :将三相电流 Ia, Ib 转换为直轴/交轴电流 Id, Iq 。
  3. PI调节 : Id_ref 通常设为0(最大转矩电流比MTPA), Iq_ref 由速度环的输出给出; Id 和 Iq 分别进入各自的PI控制器,输出 Vd 和 Vq 。
  4. 反Park变换 :将 Vd, Vq 转换回静止坐标系下的 Valpha, Vbeta 。
  5. SVPWM生成 :将 Valpha, Vbeta 映射为三相占空比,并更新定时器的比较寄存器。
  6. 速度环计算 : 在此步骤中,调用 GetMotorSpeed() 获取当前速度 n_fb ,并将其与速度给定值 n_ref 一起送入速度PI控制器,计算出 Iq_ref 。

关键在于,速度环的计算必须放在主循环的末尾,紧邻SVPWM更新之前。这是因为速度环的输出 Iq_ref 是电流环的输入,其计算结果必须在下一个PWM周期开始前就绪。如果将 GetMotorSpeed() 放在主循环开头,那么它获取的是“上一个”PWM周期结束时的速度,存在一个采样延迟,会降低速度环的响应带宽。

此外,必须注意 数据一致性 。 GetMotorSpeed() 返回的 n_fb 是一个在TIM6中断中计算出的瞬时值,而主循环是一个在Systick中断中执行的上下文。若二者没有共享内存保护机制,可能会在主循环读取 n_fb 的瞬间,TIM6中断恰好更新了它,导致读取到一个“撕裂”的值(高位是旧值,低位是新值)。为避免此问题,应在 GetMotorSpeed() 函数内部,将计算出的 n 值写入一个 volatile 的全局变量 motor_speed ,并在主循环中读取该变量时,使用 __disable_irq() 临界区保护,或采用双缓冲技术(ping-pong buffer),确保读取的始终是一个完整的、未被中断打断的32位值。

9. 性能瓶颈分析与优化方向

尽管M法在中高速段表现优异,但其固有的量化误差(Quantization Error)是无法回避的物理极限。在一个1 ms的采样周期内,若电机转速为1 r/min,则产生的脉冲数仅为 $ \frac{4096}{60000} \approx 0.068 $,这意味着在绝大多数采样周期内, total_delta 都为0,直到累积了15个周期才可能出现一次非零计数。这导致低速时速度曲线呈现“阶梯状”,分辨率极差。

为突破此瓶颈,工程上可采取以下优化策略:

提高采样频率 :将TIM6的周期从1 ms缩短至500 µs或250 µs。这能将低速分辨率提升2倍或4倍。但代价是中断频率翻倍,CPU负载线性增加。需评估MCU剩余资源是否允许。

多周期平均 :不追求单次采样的高分辨率,而是对连续N个1 ms周期的 total_delta 进行累加,再用总时间 N * 1 ms 去计算平均速度。例如,N=8,则有效采样周期为8 ms,但分辨率提升了8倍。此方法牺牲了部分动态响应性,但极大地平滑了低速噪声。

M/T混合法 :在中高速段( |n| > 100 r/min )使用标准M法;在低速段( |n| < 10 r/min )自动切换至T法,利用Z相脉冲的周期来计算速度( n = 60 / (T_z * 1) ,其中 T_z 是两次Z相脉冲的时间间隔)。这需要额外的定时器(如TIM2)来捕获Z相,增加了硬件复杂度,但能实现全速域的高精度。

硬件升级 :选用更高线数的编码器(如2500线、5000线)或支持绝对值输出的多圈编码器。前者直接提升了 P ,后者则彻底规避了Z相累计的误差来源。但这会增加系统成本和布线复杂度。

在本工程的现有框架下,最务实、零成本的优化是 改进滤波算法 。将简单的滑动平均滤波器(Moving Average Filter)替换为一个更先进的卡尔曼滤波器(Kalman Filter)。卡尔曼滤波器能融合编码器的位置测量( θ )和速度测量( n ),并结合电机的运动学模型( θ_dot = n ),对速度进行最优估计。它不仅能抑制噪声,还能预测未来状态,有效补偿采样延迟,是高端伺服驱动器的标准配置。其C语言实现虽然比二阶LPF复杂,但完全可以在STM32F4上实时运行。

10. 工程实践中的典型问题与解决方案

在将M法测速集成到实际FOC项目中时,我曾多次遇到一些看似诡异、实则有迹可循的问题。记录并分享这些“踩坑”经验,或许比单纯罗列理论更有价值。

问题一:“速度值在零附近疯狂抖动”
现象:电机静止时, GetMotorSpeed() 返回值在-2、0、+3之间随机跳变。
原因:并非算法错误,而是编码器A/B相在静止时因机械间隙或微小振动产生了无效的“晃动”脉冲。这些脉冲被计数器捕获,导致 total_delta 非零。
解决方案:在 GetMotorSpeed() 函数的最后,加入一个“死区”(Dead Band)判断。若 |n| < threshold (例如5 r/min),则强制将 n 设为0。这个 threshold 应略大于 1 ms 周期内单个脉冲所代表的最小速度( 60 / P = 60 / 4096 ≈ 0.0146 r/min ),例如设为 1 r/min 。这并非掩盖问题,而是承认物理世界的不完美,并在控制层面进行合理妥协。

问题二:“电机反转时速度值为正”
现象:手动反转电机,上位机显示速度值为正值,且数值巨大。
原因:方向判定逻辑错误。最常见的错误是将A、B相的硬件连接顺序与软件中的状态表弄反了。例如,硬件上将编码器的A相接到了MCU的Pin9,B相接到了Pin8,但软件中仍按Pin8=A、Pin9=B来读取和查表。
解决方案:在 ReadEncoderState() 函数中,加入一个调试输出,将读取到的A、B电平和计算出的 dir 值同时打印出来。缓慢手动旋转电机半圈,观察 dir 是否随旋转方向稳定地在+1和-1之间切换。若相反,则交换A/B相的读取顺序或修改状态表。

问题三:“Z相累计圈数不准确”
现象:电机旋转了10圈, z_count 的值却是9或11。
原因:Z相脉冲宽度太窄,或中断优先级被更高优先级的中断(如ADC转换完成中断)长时间阻塞,导致Z相中断丢失。
解决方案:首先,检查Z相中断的优先级,确保其不低于TIM6中断;其次,在Z相中断服务函数中,移除所有非必要的代码,只保留对 z_count 的增减操作;最后,增加一个硬件上的Z相脉冲展宽电路(如一个单稳态触发器),将微秒级的脉冲展宽至毫秒级,从根本上杜绝丢失。

这些问题的解决,往往不在于多么高深的理论,而在于对硬件信号、中断时序、软件状态这些最基础要素的敬畏与细致。每一次成功的调试,都是对“工程师”这个词最朴实的注解。

ABZ正交编码 - 异步电机常用的位置信息确定方式 例如:如果使用的编码器为 2500 线,即电机转一周反馈的 A、 B 脉冲数都为 2500个,让电机转一周, 若编码器反馈输入模式为 4 倍计数, 编码器计数器的值为 10000;2 倍计数:若为正向计数, 编码器计数器的值为 A 反馈脉冲数的 2 倍;测量位置信息可以通过 A B的脉冲数量,也可以通过测量A或者B的频率进行实现,由此产生的差异仅仅是ASW算法的一点不同而已。若为负向计数, 编码器计数器值为 B 反馈脉冲数。每转一周,索引相,即Z相经过发光二极管一次,输出一个脉冲,可作为编码器的机械零位。 阅读详情

相关推荐

STM32 HAL库实现增量式PID速度环:编码器M法测速与PWM输出完整代码解析

本文详细解析了如何使用STM32 HAL库实现增量式PID速度环控制,涵盖编码器M法测速与PWM输出的完整代码实现。针对智能车和机器人开发中的速度控制需求,提供了从硬件配置到算法实现的全面解决方案,包括增量式PID算法优势、编码器测速原理及PWM驱动配置,帮助开发者快速构建高效稳定的速度闭环控制系统。

weixin_30731305的博客 529

stm32霍尔编码器电机测速原理six

如果不清楚电机功率,可以多试几个值,电源有电流显示的话观察下零点校准时的电流,只要在0.2A — 0.8A这个范围内就行,电流太小电机无力,校准可能不准确,电流太大电机会发热,容易损坏电机。voltage_sensor_align是电机零点校准时的电压值,需要根据电机功率设置,100W以内的电机基本属于小功率,可以设置的大一点,200W以上的属于大功率,设置的小一点。A、B两相相差90度,可通过比较A相在前还是B相在前,以判断编码器的正转与反转,通过零位脉冲,可获得编码器的零位参考位。

link_start_zhx的博客 2012

入门电机系列之5编码器

入门电机系列之5编码器

qq_35653974的博客 4656

增量式编码器详解

详细介绍增量式光电编码器的基本原理,并以 STM32 和 FPGA 平台为例完成驱动设计

记录代码与生活 2万+

STM32实战:如何用增量式编码器实现电机精准测速(附完整代码)

本文详细介绍了基于STM32的增量式编码器电机精准测速实战方案。通过剖析STM32定时器的编码器接口模式,结合M法测速原理,提供了包含抗干扰处理、计数器溢出管理及软件滤波的完整代码实现,并探讨了如何将稳定的速度反馈集成到PID控制环中,以实现高精度的电机速度闭环控制。

weixin_29189377的博客 581

STM32编码器测速实战:从硬件连接到M/T法算法详解

在嵌入式系统与运动控制领域,实时精确的速度测量是实现闭环控制的基础。其核心原理是通过传感器(如增量式编码器)将物理旋转转换为数字脉冲信号,微控制器对这些脉冲进行计数与解码,从而计算出转速与方向。这项技术的核心价值在于为PID控制、机器人导航、智能小车等应用提供了关键的状态反馈,是实现精准位置伺服、速度调节的前提。针对常见的测速需求,工程师需要根据速度范围在M法(频率法)、T法(周期法)和M/T法(混合法)之间进行选型与优化。本文聚焦于STM32平台,深入剖析如何利用其硬件编码器接口高效处理A/B相脉冲,并详

weixin_29190651的博客 357

STM32 ABZ编码器模式详解

STM32 ABZ编码器配置

demonneverhunts的博客 1万+

编码器测速三法:M法、T法与MT法的原理与实战选型

本文详细解析了编码器测速的三种方法:M法、T法与MT法的原理与实战选型。M法适用于高速场景,T法擅长低速测量,而MT法则通过混合策略实现全范围精准测速。文章结合STM32实现案例,提供了误差分析与优化方案,帮助工程师根据具体应用场景选择最佳测速方法。

weixin_29164497的博客 357

STM32增量式编码器M法测速原理与实现

增量式编码器是电机控制系统中最常用的位置与速度传感元件,其测速本质是将脉冲频率或周期转换为转速(rpm)。M法(频率测量法)以固定时间窗口统计脉冲数,具有实现简单、实时性好、抗干扰强等优势,广泛应用于中高速永磁同步电机(PMSM)的FOC闭环控制。其核心在于准确获取单位时间内的净脉冲数,并正确处理计数器溢出、旋转方向及多圈累计等嵌入式关键问题。结合STM32硬件编码器接口与定时器资源,可高效完成四倍频计数、1ms等间隔采样与原子化数据读取。本文深入解析M法测速的数学模型、溢出鲁棒算法与工程落地细节,覆盖从原

brandy的博客 729

AB编码器测速原理与STM32实现:四倍频、M/T法测速及排坑指南

增量式编码器是电机速度测量与闭环控制中常见的传感器,它通过A、B两路相位差90度的方波信号输出角度变化量。理解其正交信号原理后,可利用四倍频技术提高分辨率,在仅增加少量硬件成本的情况下显著提升低速测量精度。在嵌入式系统中,速度测量通常有M法、T法和M/T法三种策略,M/T法兼顾高低速性能,适合宽速域伺服与机器人应用。本文以STM32定时器编码器模式为例,详细说明AB编码器测速的硬件接线、初始化配置、速度计算与滤波方法,并梳理工程实践中常见的信号干扰、方向判断和脉冲丢失问题,为单片机测速与速度闭环项目提供可直

weixin_31887307的博客 212

STM32实战:手把手教你用编码器实现电机精准测速(附完整代码)

本文详细介绍了如何利用STM32微控制器和编码器实现电机精准测速的完整方案。从硬件选型到软件配置,包括定时器编码器模式设置、速度测量算法实现及PID控制集成,提供了可直接应用的代码示例。特别针对高精度测速需求,讲解了误差分析和性能优化方法,帮助开发者快速构建稳定的电机测速系统。

xxx12的博客 1036

STM32增量式编码器M法测速工程实现

增量式编码器测速是电机闭环控制的基础技术,其核心在于将A/B相正交脉冲序列转化为连续、可信的转速物理量(rpm)。原理上依赖于脉冲计数与时间基准的精确映射,涉及四倍频解码、抗干扰滤波、跨圈计数校准等关键环节。该技术具备高分辨率、强鲁棒性与低CPU开销优势,广泛应用于永磁同步电机(PMSM)的FOC系统、工业伺服驱动及嵌入式运动控制场景。在STM32平台中,通过定时器编码器接口模式与周期性采样中断协同,可高效实现M法测速模块——尤其适合中高速区间(如>30rpm)的稳定反馈需求,是构建高性能速度环路的工程基石

brandy的博客 113

AB编码器测速全解析:STM32实现M法/T法/M-T法转速测量

增量式编码器是电机转速测量中最常见的传感器之一,而AB相正交输出则为其赋予了方向判断与四倍频能力。理解AB信号的基本形态与相位关系,是掌握转速测量原理的关键。工程实践中,M法固定时间数脉冲,适合中高速场景;T法测量脉冲间隔,低速时精度更高;M/T法则结合两者优势,在宽速度范围内保持稳定。这些技术不仅广泛应用于小车、云台、机械臂等运动控制项目,更是PID速度闭环、位置控制的基础数据来源。测速数据的质量直接决定控制效果,因此掌握滤波、去抖、计数器回绕处理等实用技巧同样重要。基于STM32定时器编码器模式,可实现

weixin_29174385的博客 84

电机应用开发-编码器的使用

建立在一个已知频率的高频脉冲并对其计数,计数时间由捕获到的编码器相邻两个脉冲的间隔时间T决定,计数值为M。而在低转速时,T足够大,测量周期内的M也足够多。在一个相对固定的时间内,计数编码器脉冲数为M0,并计数一个已知频率为F的高频脉冲,计数值为M1,设编码器单圈总脉冲数为C,则转速n = FM0/CM1。假设有个增量式编码器的分辨率是600PPR,能分辨最小角度是0.6°,对它进行4倍频后就相当于把分辨率提高到600*4=2400PPR,此时编码器能够分辨的最小角度为0.15°。

weixin_47077788的博客 1788

编码器测速:正交解码与M/T法测速精度对比——定时器编码器模式

摘要:在电机控制、机器人伺服和精密运动系统中,编码器测速精度直接决定了闭环控制的性能上限。本文深入剖析增量式编码器的正交解码原理,对比M法、T法与M/T法三种测速算法的精度特性,并以STM32定时器编码器模式为核心,给出完整的硬件配置方案与软件实现代码,实测验证全速域测速精度可达0.1%以内。编码器层:1000线增量式编码器,输出A/B/Z三相脉冲信号调理层:RC滤波 + 施密特整形,确保信号质量硬件解码层:STM32 TIMx编码器模式,自动四倍频计数采样层。

从事移动开发八年,csdn博客专家,阿里云特邀专家,华为云云享专家,高级网络信息安全工程师,大数据工程师(高级),python技术开发(高级),HarmonyOS 应用开发者高级认证,现在某学校任教。 1万+

STM32编码器电机测速与PID速度闭环控制从入门到实现

在电机控制系统中,增量式编码器与定时器是不可或缺的基础组件。通过STM32的定时器编码器接口模式,可以同时捕获A/B两路正交脉冲信号,硬件自动完成方向判别与四倍频计数,从而精确感知电机转速。针对不同转速区间,工程上常采用M法、T法或M/T法进行速度检测,其中M法适合中高速场景,T法在低速下分辨率更高。速度闭环则依赖PID控制算法,将编码器测得的实际转速与目标转速比较,经过比例、积分、微分运算后输出PWM占空比,实现对直流减速电机的稳定调速。这一套基于标准外设库的实践方案广泛适用于智能小车底盘、云台转台以及毕

weixin_33925615的博客 123

使用stm32实现电机的PID控制

使用单片机引脚的跳变信号触发中断,然后在中断里判断两个编码器引脚的电平,让计数值增加或者减少。我们规定,正转计数值++,反转正转计数值—。采用4倍频计数,就是A相的上升沿、下降沿和B相的上升沿、下降沿都触发中断。A相边沿B相电平对应区域计数值上升沿02下降沿14B相边沿A相电平对应区域计数值上升沿13下降沿01当电机反转时,A相、B相的信号与正转时的相位相差90度,换句话说就是,正转时A相先触发上升沿,反转时B相先触发上升沿。A相边沿B相电平对应区域计数值。

指尖动听知识库 5262

STM32编码器电机速度控制与测速实现:从正交脉冲到PID闭环

电机调速系统中,转速反馈的准确性直接决定闭环控制品质。增量式编码器因能同时提供位置与方向信息,成为工业与嵌入式领域最常用的速度检测元件。其正交脉冲信号通过定时器硬件解码,可有效降低CPU负载并提高计数可靠性。利用STM32定时器编码器模式采集A/B相脉冲,配合M法/T法测速,再经增量式PID调节PWM占空比,即可构成完整的数字速度闭环。该方案广泛应用于AGV小车、机械臂、3D打印机等场景,是嵌入式开发者从基础外设走向运动控制的关键技能。文章围绕编码器接口配置、脉冲差值计算、速度滤波与PID整定等工程细节,梳

weixin_31476015的博客 112
上一篇: STM32F4工程模板构建:时钟、GPIO、中断与低功耗系统级初始化
下一篇: STM32L431驱动BH1750光照传感器实战:I²C通信与智能光控
php55
博客等级 码龄15年 51粉丝 1553原创
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符  | 博主筛选后可见
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付:10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值