当前位置：首页 > news >正文

STM32G4编码器测速踩坑记：从M法误差到T法实战，我的精度提升10倍之旅

news 2026/6/10 11:36:30

STM32G4编码器测速踩坑记：从M法误差到T法实战，我的精度提升10倍之旅

第一次在NUCLEO-G431RB开发板上看到编码器测速数据时，我盯着屏幕上跳动的数值皱起了眉头。作为一款170MHz主频的Cortex-M4内核MCU，STM32G4系列理应在电机控制领域表现出色，但低速状态下0.25Hz的分辨率和持续跳变的速度值，让我的高精度伺服控制方案陷入了困境。这次经历让我深刻认识到：在嵌入式系统开发中，算法选择往往比硬件性能更能决定最终效果。

1. M法测速的先天缺陷与问题定位

那是一个周五的深夜，实验室只剩下示波器的荧光在闪烁。我正用TIM1生成模拟编码器信号，通过1024线编码器的M法测速程序验证性能。当设定速度低于1Hz时，数据采集终端开始出现规律性波动：

// M法测速典型实现 uint32_t pulse_count = TIM3->CNT; // 获取脉冲计数值 TIM3->CNT = 0; // 计数器清零 float speed_hz = (pulse_count * 100.0f) / (ENCODER_PPR * SAMPLE_TIME_MS);

测试数据显示，在0.1Hz设定速度下，测量结果在0.00Hz到0.25Hz之间跳变。这种量化误差本质上是M法的固有缺陷——当脉冲间隔超过采样周期时，计数器可能捕获0个或1个脉冲，导致速度计算产生±100%的误差。

M法在低速下的三大痛点：

分辨率受限：最小可检测速度=1/(PPR×采样周期)
采样异步：速度计算时刻与脉冲边沿不同步
累积误差：单个脉冲丢失会造成速度值阶跃变化

通过频谱分析仪观察TIM3的输入信号后，我确认硬件连接没有问题。此时摆在面前的选择很明确：必须放弃M法，寻找更适合低速场景的测速方案。

2. STM32G4定时器互联特性挖掘

查阅STM32G4参考手册时，TIMx定时器章节中"Trigger Controller"部分引起了我的注意。这个在G4系列中新引入的特性，允许定时器之间建立精确的硬件级联动：

TIMx定时器的TRGO信号可通过内部连线触发其他定时器的捕获/计数操作，无需占用GPIO资源

这个发现让我立即画出了新的方案框图：

[编码器信号] → TIM3(编码器模式) → TRGO输出 → TIM2(捕获模式)

关键配置参数对比表：

参数项	TIM3(16位解码)	TIM2(32位捕获)
工作模式	正交编码器模式	输入捕获模式
时钟源	内部170MHz	内部170MHz
分辨率	16位(0-65535)	32位(0-4294967295)
最小可测频率	2593Hz(170M/65536)	0.04Hz(170M/2^32)
特殊功能	四倍频计数	脉冲宽度直接测量

CubeMX中的具体配置步骤如下：

TIM3编码器模式配置：
- Combined Channels = Encoder Mode
- Encoder Mode = TI1 and TI2
- Trigger Output = Enabled
TIM2捕获模式配置：
- Slave Mode = Trigger Mode
- Trigger Source = ITR1 (来自TIM3)
- Input Capture = Direct Mode
- Capture Prescaler = DIV1

// 关键初始化代码片段 LL_TIM_Encoder_Init(TIM3, &encoder_init); LL_TIM_SetTriggerOutput(TIM3, LL_TIM_TRGO_UPDATE); LL_TIM_IC_Init(TIM2, LL_TIM_CHANNEL_CH1, &ic_init); LL_TIM_SetSlaveMode(TIM2, LL_TIM_SLAVEMODE_TRIGGER);

3. T法测速的DMA优化策略

当电机转速超过100RPM时，新的问题出现了——频繁的捕获中断导致CPU负载飙升。通过逻辑分析仪抓取的数据显示，中断响应时间波动达到±5μs，这在高精度应用中是不可接受的。

解决方案的核心在于三点：

使用DMA自动搬运捕获值
采用32位环形缓冲区
实现异步速度计算

具体实现时，我设计了双缓冲机制：

#define DMA_BUF_SIZE 256 volatile uint32_t capture_buf[DMA_BUF_SIZE]; volatile uint16_t dma_index = 0; void MX_DMA_Init(void) { __HAL_RCC_DMA1_CLK_ENABLE(); hdma_tim2_up.Instance = DMA1_Channel1; hdma_tim2_up.Init.Request = DMA_REQUEST_TIM2_UP; hdma_tim2_up.Init.Direction = DMA_PERIPH_TO_MEMORY; hdma_tim2_up.Init.PeriphInc = DMA_PINC_DISABLE; hdma_tim2_up.Init.MemInc = DMA_MINC_ENABLE; hdma_tim2_up.Init.PeriphDataAlignment = DMA_PDATAALIGN_WORD; hdma_tim2_up.Init.MemDataAlignment = DMA_MDATAALIGN_WORD; hdma_tim2_up.Init.Mode = DMA_CIRCULAR; hdma_tim2_up.Init.Priority = DMA_PRIORITY_HIGH; HAL_DMA_Init(&hdma_tim2_up); __HAL_LINKDMA(&htim2, hdma[TIM_DMA_ID_UPDATE], hdma_tim2_up); HAL_DMA_Start(&hdma_tim2_up, (uint32_t)&TIM2->CCR1, (uint32_t)capture_buf, DMA_BUF_SIZE); }

DMA配置的五个关键点：

使用TIM2_UP请求而非CC1事件触发DMA
内存地址自增模式使能
采用循环缓冲减少内存拷贝
数据宽度设置为32位匹配TIM2 CCR寄存器
高优先级确保数据传输及时性

4. 非对称PWM验证方案设计

为了验证T法测速的实际精度，我利用STM32G4的非对称PWM模式构建了一套闭环测试系统：

TIM1(主) → 非对称PWM → TIM3(编码器接口) → TIM2(捕获) → 速度计算

TIM1的特殊配置如下：

// 非对称PWM模式初始化 LL_TIM_OC_SetMode(TIM1, LL_TIM_CHANNEL_CH1, LL_TIM_OCMODE_PWM1); LL_TIM_OC_SetMode(TIM1, LL_TIM_CHANNEL_CH2, LL_TIM_OCMODE_PWM2); LL_TIM_OC_SetPolarity(TIM1, LL_TIM_CHANNEL_CH1, LL_TIM_OCPOLARITY_HIGH); LL_TIM_OC_SetPolarity(TIM1, LL_TIM_CHANNEL_CH2, LL_TIM_OCPOLARITY_HIGH); LL_TIM_EnableMasterSlaveMode(TIM1);

测试过程中发现一个有趣的现象：当设定速度低于0.1Hz时，M法数据完全失效，而T法仍能保持稳定输出。通过改变TIM1的ARR值模拟不同转速，得到以下对比数据：

设定速度(Hz)	M法测量值(Hz)	T法测量值(Hz)	M法误差(%)	T法误差(%)
0.05	0.00-0.25	0.049-0.051	>100	<2
0.10	0.00-0.25	0.098-0.102	>100	<2
0.50	0.25-0.75	0.495-0.505	50	<1
1.00	0.75-1.25	0.998-1.002	25	<0.2

最终测试数据显示，在0.1Hz工况下，T法将测速精度提升了近50倍。这个改进不仅解决了低速跳变问题，还为后续的位置环控制奠定了坚实基础。

5. 工程实践中的经验结晶

经过两周的反复调试，我总结了STM32G4编码器测速的五大黄金法则：

定时器选型原则：
- 解码用16位定时器（TIM3/TIM4）
- 捕获用32位定时器（TIM2/TIM5）
- 避免使用带有霍尔接口的定时器

时钟配置要点：

// 确保所有定时器使用相同的APB时钟 RCC_PeriphCLKInitTypeDef PeriphClkInit = {0}; PeriphClkInit.Tim2ClockSelection = RCC_TIM2CLKSOURCE_PCLK1; PeriphClkInit.Tim3ClockSelection = RCC_TIM3CLKSOURCE_PCLK1; HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit);