STM32F4 FOC 编码器电机角度与转速详解TIM3 四倍频、机械角度、电角度与测速做 FOC 无刷电机控制最基础也最容易出问题的就是电机转子位置和速度的获取。位置不对电流环解算出来的方向就是错的速度反馈不准速度环和位置环根本调不起来。而对于 STM32F4 跑 FOC 的项目来说使用正交编码器配合定时器接口模式是最常用、最稳定的方案之一。这次的核心是搞清楚三件事TIM3 怎么配置成编码器模式并实现四倍频机械角度到电角度之间怎么换算以及基于编码器脉冲如何做转速测量。文章偏向实战会给出 CubeMX 配置、寄存器说明、代码实现和常见问题排查适合正在做 FOC 控制、无感/有感矢量控制或者对编码器测速有需求的开发者参考。我会重点展开以下内容STM32F4 定时器编码器模式的工作原理TIM3 四倍频的实现方法与计数方向判定机械角度、电角度与极对数之间的关系编码器零位与角度初始化M 法与 T 法测速的实现对比常见问题与排查思路1. 核心概念速览能力项说明主控平台STM32F4 系列以 STM32F407 为例其他型号类似编码器类型增量式正交编码器常见 200~4096 线定时器模块TIM3可选 TIM1/TIM2/TIM4/TIM5/TIM8 等四倍频原理利用 A/B 两路信号的 4 个边沿提高分辨率角度类型机械角度、电角度电角度需乘极对数测速方法M 法测频率、T 法测周期、M/T 法综合资源需求1 个四倍频定时器 简单数学运算无额外传感器用于场景FOC 电流环、速度环、位置环反馈云台/机器人/伺服驱动T 法测速适合低速场景M 法测速适合中高速场景M/T 法适合宽速度范围场景。实际项目中可以根据电机最高转速和编码器线数选择最合适的方案。2. 为什么 FOC 必须要位置信息以及编码器接口模式的原理FOC 的核心是把三相交流电机的定子电流通过 Clarke 变换和 Park 变换解耦成 d 轴和 q 轴两个直流分量去控制。而 Park 变换中需要用到转子的电角度这个角度来源通常有几个方向霍尔传感器、编码器、磁编码器如 AS5047P、或者无感观测器如滑模观测器 SMO、龙伯格观测器。编码器的优势在于精度高、响应快、抗干扰能力强。增量式编码器输出 A、B 两路相位相差 90° 的正交脉冲通过判断 A、B 的相对相位先后来确定旋转方向。STM32F4 的通用定时器有一个非常实用的特性编码器接口模式。这种模式下定时器硬件会自动处理 A、B 两路信号的边沿检测、方向判断和计数方向切换不需要 CPU 额外干预而且支持四倍频。四倍频的意思是在编码器线数为 N 的情况下A 相和 B 相各有上升沿和下降沿也就是每个完整的 A/B 周期可以产生 4 个计数脉冲。最终的分辨率就是4 * N。以常见 1000 线编码器为例四倍频后每圈脉冲数为 4000角度分辨率可以达到360° / 4000 0.09°。对于大多数 FOC 应用来说这个精度已经完全够用。在编码器接口模式下TIM3 根据 A、B 相的电平组合自动切换向上计数或向下计数CNT 寄存器直接反映位置增量而 CR1 寄存器的 DIR 位则可以反馈当前方向。// 以 HAL 库获取当前方向为例 uint8_t direction __HAL_TIM_IS_GET_DIRECTION(htim3);这个方向信息在测速和角度解算中会很常用。3. STM32F4 定时器编码器模式与 TIM3 四倍频配置3.1 TIM3 引脚映射在 STM32F4 上TIM3 的通道 1CH1默认映射到 PA6通道 2CH2默认映射到 PA7但通过 AF 复用配置也可以映射到 PC6 和 PC7。使用编码器接口模式时通常让通道 1 接编码器 A 相通道 2 接编码器 B 相。使用 STM32CubeMX 配置方法如下使能 TIM3将 Channel1 和 Channel2 均配置为Encoder Mode。配置Combined Channels为Encoder Mode TI1 and TI2这是最常用的四倍频模式。配置计数周期Counter Period这个值决定 CNT 的最大计数值一般设为四倍频后的单圈脉冲数减 1例如 4000 线对应 16000。配置输入滤波器和预分频器。在 CubeMX 中定时器配置界面相关参数如下Counter Period等于四倍频之后的单圈总脉冲数减 1。Input Filter建议设置 2 到 8可以滤掉数字噪声。Input Prescaler通常设为 1即不分频。这里的关键是理解编码器模式下定时器计数值是在 0 和 Counter Period 之间往复计数当计数到达上限后如果继续正转会回绕到 0。这就是角度计算中取余的基本逻辑。3.2 TIM3 编码器模式寄存器配置如果不想用 CubeMX也可以直接用寄存器配置。核心寄存器包括TIM_CR1设置计数方向编码器模式下由硬件自动管理DIR 位只读。TIM_SMCR选择从模式为编码器模式SMS 0011。TIM_CCMR1设置通道 1 和通道 2 的输入捕获映射到 TI1、TI2。TIM_CCER使能捕获并配置极性通常两个通道的极性相同。TIM_ARR设置计数周期。TIM_CNT清零作为位置计数器使用。一个简化配置示例void TIM3_Encoder_Init(void) { RCC-APB1ENR | RCC_APB1ENR_TIM3EN; GPIO_InitTypeDef GPIO_InitStruct {0}; __HAL_RCC_GPIOA_CLK_ENABLE(); GPIO_InitStruct.Pin GPIO_PIN_6 | GPIO_PIN_7; GPIO_InitStruct.Mode GPIO_MODE_AF_PP; GPIO_InitStruct.Pull GPIO_PULLUP; GPIO_InitStruct.Speed GPIO_SPEED_FREQ_VERY_HIGH; GPIO_InitStruct.Alternate GPIO_AF2_TIM3; HAL_GPIO_Init(GPIOA, GPIO_InitStruct); TIM3-PSC 0; TIM3-ARR 4000 * 4 - 1; // 1000线编码器四倍频 TIM3-CCMR1 | TIM_CCMR1_CC1S_0 | TIM_CCMR1_CC2S_0; TIM3-CCMR1 | TIM_CCMR1_IC1F_2 | TIM_CCMR1_IC2F_2; TIM3-CCER | TIM_CCER_CC1E | TIM_CCER_CC2E; TIM3-SMCR | TIM_SMCR_SMS_0 | TIM_SMCR_SMS_1; // 编码器模式3 TIM3-CR1 | TIM_CR1_CEN; }3.3 四倍频方向判定逻辑编码器接口模式下定时器的硬件逻辑比较特殊计数器并不是单纯地在每个上升沿或下降沿加一而是根据 A、B 两相的电平状态组合来决定是加一、减一还是不变。在四倍频模式下每个信号周期的 4 个边沿都会触发一次更新每次更新的方向由当前时刻两路信号的电平状态决定。方向判定完全由硬件完成不需要在中断里读取两路 GPIO 电平来判断方向这降低了中断负载。实际测试中当电机正转时TIM3 的 CNT 寄存器递增反转时 CNT 递减。反转越过零后会从 ARR 值往下回绕表示角度取模时的自然流转。4. 机械角度与电角度的关系及代码实现4.1 机械角度计算机械角度也就是电机转轴实际旋转的物理角度。增量式编码器没有绝对零位所以上电后默认机械角度为 0需要先校准零点例如上电时让电机对齐到一个确定的电角度再清零编码器计数或者在编码器 Z 相Index 信号到来时清零。机械角度计算公式角度计数原始值 TIM3-CNT 机械角度 (TIM3-CNT / 单圈总脉冲数) * 360° 机械角度 (TIM3-CNT % 单圈总脉冲数) * 360° / 单圈总脉冲数在 STM32F4 上用一个 uint16_t 读取 CNT 值即可范围已经限制在 ARR 以内。注意CNT 计数器是回绕计数的所以读取后需要立即与 ARR 计算取模或者把结果存为连续累加位置。为了提高计算速度FOC 程序中尽量避免浮点运算可以使用 Q15 或 Q24 格式表示角度。例如将 360° 映射到 Q15 的 0~32767或者直接存储在 int32_t 变量中每圈累计一个固定增量。示例代码#define ENCODER_PULSE_PER_REV (1000 * 4) // 1000线编码器四倍频 float Encoder_GetMechanicalAngle(TIM_HandleTypeDef *htim) { uint16_t cnt __HAL_TIM_GET_COUNTER(htim); float angle_deg ((float)cnt / ENCODER_PULSE_PER_REV) * 360.0f; return angle_deg; }4.2 电角度计算电角度的核心公式是电角度 机械角度 × 极对数Pole Pairs对于永磁同步电机PMSM极对数是电机磁极对数。例如一个 4 极电机极对数为 2电机每转一圈电角度变化 720°。在实际 FOC 解算中更常用的是电角度的周期形式电角度电角周期整数部分 (机械角度计数 × 极对数) / 单圈总脉冲数 电角度剩余值 (机械角度计数 × 极对数) % 单圈总脉冲数以 TIM3 计数值为例#define POLE_PAIRS 4 // 4对极即8极电机按实际填写 uint16_t mechanical_cnt __HAL_TIM_GET_COUNTER(htim3); uint32_t electrical_cnt (uint32_t)mechanical_cnt * POLE_PAIRS; electrical_cnt % ENCODER_PULSE_PER_REV; float electrical_angle ((float)electrical_cnt / ENCODER_PULSE_PER_REV) * 2.0f * PI;这里有一个 FOC 开发中很常见的坑电角度计算的超前滞后问题。编码器安装后A 相与电机 U 相之间的相位关系不是固定的如果电角度算出来电流环无法正常出力通常需要调整一个非常量偏移角度。比较稳妥的做法是在电机对齐到任意一个已知电角度后记录编码器计数然后计算实际电角度偏移。一个常用的校准流程给电机施加 U 相正方向电流例如 d 轴电流正向让转子锁止到一个已知位置。读取当前编码器值记录为encoder_zero_offset。在运行时电角度 (编码器计数 - encoder_zero_offset) * 极对数 * 角度系数。这样可以在代码中统一处理安装偏移。4.3 方向对角度的影响编码器方向与电机 FOC 方向相反时最直观的表现是电流环调试时电机飞车、过流或者完全转不动。处理方法有两个在电机侧交换其中两相线使电机实际转向与编码器方向一致在软件侧把编码器计数取反即cnt -cnt然后再参与角度计算。第二种方法改动小适合调试阶段快速验证。注意取反后要处理负数取模问题int32_t enc_raw (int16_t)(__HAL_TIM_GET_COUNTER(htim3)); int32_t enc_direction_corrected -enc_raw; enc_direction_corrected % (int32_t)ENCODER_PULSE_PER_REV; if (enc_direction_corrected 0) { enc_direction_corrected ENCODER_PULSE_PER_REV; }5. 位置累加与连续角度跟踪增量式编码器天然只提供增量信息在角速度较高时如果直接读取 CNT 寄存器可能会面临一个问题两次读取之间计数器可能已经回绕了一次。回绕会导致角度跳变。解决方式有两种用 STM32 的定时器溢出中断Update Interrupt在回绕时维护一个encoder_overflow_count变量把位置扩展为 32 位。在高速控制循环中假设每次读取 CNT 的间隔足够短例如 FOC 电流环 10kHz~20kHz两次读取之间最多只回绕一次因此可以通过判断 CNT 变化量是否大于 ARR 的一半来判断是否回绕。推荐使用 32 位位置累计方式这也是工业伺服驱动中常见做法volatile int32_t encoder_raw_count 0; volatile int32_t encoder_overflow_count 0; uint16_t last_cnt 0; void Encoder_UpdateOverflow(void) { uint16_t current_cnt __HAL_TIM_GET_COUNTER(htim3); int16_t diff (int16_t)(current_cnt - last_cnt); if (diff (int16_t)(ENCODER_PULSE_PER_REV / 2)) { encoder_overflow_count--; } else if (diff -(int16_t)(ENCODER_PULSE_PER_REV / 2)) { encoder_overflow_count; } encoder_raw_count (int32_t)encoder_overflow_count * ENCODER_PULSE_PER_REV current_cnt; last_cnt current_cnt; }注意如果定时器 ARR 设置为四倍频单圈总脉冲数减 1那么溢出中断频次在电机高速转动时可能较高需要在中断函数中只做简单的累加运算避免浮点计算和长耗时分支。更简单的方式是利用定时器的 TI1 或 TI2 边沿触发 DMA 或中断但会占用 CPU 资源。实际项目一般把编码器溢出更新放在 FOC 主循环中而不是中断服务函数中。6. 基于 TIM3 编码器的转速测量M 法、T 法与 M/T 法6.1 M 法测速M 法测速的基本思路是在固定时间窗口内统计编码器脉冲数然后用脉冲数除以时间得到频率再乘以每个脉冲对应的角度增量得到转速。公式转速 (RPM) (脉冲数 / 时间窗口秒) * 60 / 单圈总脉冲数M 法适合高速场景因为高速时脉冲数多量化误差相对较小。低速时如果脉冲数太少测出的转速会跳跃非常严重。示例代码uint16_t cnt1, cnt2; int32_t pulse_count; float rpm; cnt1 __HAL_TIM_GET_COUNTER(htim3); HAL_Delay(10); // 时间窗口 10ms cnt2 __HAL_TIM_GET_COUNTER(htim3); // 注意处理圈内回绕 pulse_count (int32_t)(int16_t)(cnt2 - cnt1); // 每10ms计一个数对应的转速 脉冲数 / (单圈总脉冲数 * 0.01) * 60 rpm (float)pulse_count / (ENCODER_PULSE_PER_REV * 0.01f) * 60.0f;HAL_Delay 实际项目中不推荐在 FOC 控制循环中使用建议使用 SysTick 或固定中断周期来获取时间窗口。6.2 T 法测速T 法测速是测量两个相邻脉冲或指定数量脉冲之间的时间间隔然后用角度变化量除以时间得到转速。公式转速 (RPM) (角度增量 / 时间间隔) * 60 / 360°T 法适合低速场景因为低速时脉冲间隔长时间测量精度高而高速时如果脉冲间隔太短定时器计数可能不够精准。T 法的实现通常依赖输入捕获功能捕获相邻两次脉冲边沿的时间戳计算间隔。在 STM32F4 上可以用定时器的输入捕获通道来实现也可以借助外部中断加 DWT 周期计数。示例思路uint32_t t1, t2; uint32_t time_diff; // 在输入捕获中断中获取时间戳 t1 last_capture_time; t2 current_capture_time; if (t2 t1) { time_diff t2 - t1; } else { time_diff 0xFFFFFFFF - t1 t2; } // 每个脉冲对应的角度 360 / 单圈总脉冲数 float speed_deg_per_s (360.0f / ENCODER_PULSE_PER_REV) / (time_diff / TIMER_CLOCK_MHZ); float rpm speed_deg_per_s / 360.0f * 60.0f;6.3 M/T 法测速M/T 法结合了 M 法和 T 法的优点在低速和高速下都能保持较高精度。实现逻辑是先选定一个目标时间窗口在窗口结束后等待捕获到下一个脉冲边沿然后同时统计该时间段内的脉冲数和定时器时钟周期数。M/T 法适合宽速度范围场景但实现复杂度高一档。对于大部分 FOC 兴趣项目如果电机运行在几百到几千 RPMM 法其实就够用。6.4 速度环采样周期选择速度环采样周期一般比电流环慢很多。FOC 电流环通常运行在 10kHz~20kHz速度环可以放在 1kHz 下运行位置环可以更慢。编码器测速在这个采样周期内如果 M 法测速脉冲少于 5 个建议增大时间窗口或者切换到 T 法。7. FOC 电流环、速度环、位置环中的角度与速度接口最终在 FOC 算法中角度和速度要接入到以下位置控制流程 位置环可选- 速度环 - 电流环Id/Iq- Park 变换 - SVPWM - 三相逆变器 - 电机 角度和速度反馈 - 编码器 - TIM3 计数 - 角度/速度解算在实际代码中Park 变换和逆 Park 变换都需要电角度这个电角度必须来自编码器换算结果而不是直接使用机械角度。如果直接使用机械角度电机在带载时会发生明显的转矩波动严重时甚至无法启动。典型调用流程// FOC 中断 10kHz void FOC_ISR(void) { // 1. 获取编码器计数 uint16_t enc_cnt __HAL_TIM_GET_COUNTER(htim3); // 2. 计算机械角度和电角度 float mech_angle Encoder_GetMechanicalAngle(enc_cnt); float elec_angle Encoder_GetElectricalAngle(enc_cnt); // 3. 采样相电流 - Clarke - Park使用 elec_angle // 4. PI 调节 - 逆 Park使用 elec_angle // 5. SVPWM 输出 } // 速度环 1kHz void SpeedLoop_1kHz(void) { float rpm Encoder_GetSpeedM(); speed_pi_output Speed_PI(rpm, target_rpm); }注意这两个函数中Encoder_GetElectricalAngle需要提前完成极对数换算和零点偏移补偿否则电流环角度与实际转子位置有偏差矢量控制效果会打折扣。8. 常见问题与排查方法问题现象可能原因排查方式解决方案上电后角度跳变编码器没有绝对零位上电默认值为随机打印上电 CNT 值做零点校准或使用 Z 相归零电机反转时角度计算异常方向未处理CNT 负数取模错误打印原始 CNT 和计算角度加方向纠正负数处理角度抖动明显编码器信号有毛刺滤波不足用示波器看 A/B 波形增加输入滤波检查接线和共地M 法测速低速跳变时间窗口内脉冲数太少打印脉冲数换 T 法或加长时间窗口电流环无法正常出力电角度零位偏移未校准对齐后记录编码器值初始化时计算 offset 并补偿计数器到边界回绕未处理溢出打印 CNT 原始值加溢出计数或 32 位位置累计TIM3 编码器模式不计数引脚复用配置错误或未开启编码器模式打印 CR1、SMCR 寄存器检查 CubeMX 或寄存器配置电机噪音大、发热电角度方向反了或偏移不对检查转向和 FOC 波形调整方向/零偏排查顺序建议如果 FOC 电机转不起来建议先从编码器原始数据排查再做角度换算最后才排查电流环 PI 参数。顺序如下打印 TIM3-CNT手动旋转电机轴确认计数是否递增/递减。打印机械角度确认一圈对应 0~360°。打印电角度缓慢旋转电机确认电角度变化是机械角度的极对数倍。给一个固定电压开环测试确认电机转动方向。闭环测试先用低速速度环试再切换位置环。这一步一步排查下来编码器相关的 90% 问题都能定位到原因。9. 调参建议与工程实践9.1 编码器滤波参数STM32 定时器编码器模式的输入滤波可以有效抑制抖动。滤波值不是越大越好过大会导致真实边沿被滤掉尤其在高速下会出现丢步。建议低速场景使用中等滤波高速场景使用较小滤波或关断。电机最高转速建议滤波设置 500 RPM8~15500~3000 RPM4~8 3000 RPM0~4实际数值需要在示波器辅助下调整避免盲目取值。9.2 编码器线数选择做 FOC 时编码器线数选择需要平衡成本和性能200~500 线入门实验级四倍频后分辨率 800~2000低速表现一般。1000 线大多数 DIY FOC 项目和教学实验的主流选择四倍频后分辨率 4000。4096 线以上或磁编码器用于高性能伺服。磁编码器如 AS5047P通常直接输出 SPI 或 ABZ 信号配合 STM32F4 也很方便但那是另一套配置方式。如果手头只有 200 线的编码器做 FOC 低速实验会明显感觉到转速波动。9.3 定时器溢出中断中不要做浮点运算FOC 控制对实时性要求很高如果编码器溢出中断频率很高例如高速电机加上高线数编码器中断服务函数里尽量只处理整数变量更新。浮点角度和速度计算放在主控制循环中进行。9.4 数据打印与上位机联动调试时建议把以下数据通过串口或虚拟示波器VOFA、SerialPlot读出编码器原始计数值机械角度电角度目标速度和实际速度速度环输出和电流环给定当电角度波形在恒速旋转时应该是平滑的三角波或锯齿波如果在某个位置出现跳变大概率是角度回绕或零点偏移问题。10. 总结与下一步STM32F4 上的 FOC 编码器方案本质上就是用硬件编码器接口模式简化了位置增量的获取然后用一小段数学换算完成机械角度、电角度和速度解算。TIM3 四倍频可以基于常见 1000 线编码器达到 4000 脉冲/圈的精度配合极对数映射到电角度已经能满足多数 DIY 伺服和教学实验的需求。建议拿到板子后先做三件事第一步用示波器或逻辑分析仪确认编码器 A/B 波形和方向第二步运行基础角度解算手动转轴观察串口输出的机械角度和电角度曲线第三步用 M 法测速匹配速度环先跑通低速再逐步提速。最容易踩的坑是零点偏移和方向不一致这些问题在开环测试阶段就能暴露出来不要直接上闭环。后续可以继续扩展的方向包括M/T 法测速提升低速性能、编码器 Z 相索引归零、磁编码器 SPI 接入对比、以及把编码器反馈接入无感 FOC 观测器的启动过渡逻辑。每一步都在这个基础上加一个小模块不会影响整体架构。建议收藏备用调编码器时可以直接对照。