STM32霍尔FOC速度模式实战：从换向信号到连续电角度的关键设计

简介：面向电机控制与嵌入式开发的STM32直流无刷电机FOC矢量控制项目，采用霍尔传感器获取转子位置，并结合实时操作系统完成多任务调度，覆盖电流采样、Clarke/Park坐标变换、PWM调制及速度闭环控制等完整实现链路。压缩包共1192个文件，以c/h源码为主，辅以s汇编、icf链接脚本、uvprojx工程文件及hex固件，可在STM32开发环境中直接编译、烧录与调试。资源整体约31.42MB，适用于工业自动化、机器人、无人机等领域的电机驱动开发，也适合有一定单片机基础、希望深入理解FOC算法工程落地的开发者。目前已有674人学习下载。项目包含FOC核心算法、霍尔驱动逻辑、FreeRTOS任务划分、电机参数整定和异常处理机制，源码结构清晰，可依据实际电机参数进行移植，或作为课程设计与毕业设计的参考资料。

1. 霍尔FOC速度模式为什么比六步换向难写

第一次把霍尔BLDC跑起来时，我踩的最疼的一个坑是：六步换向能转，切到FOC速度模式就飞车。电机能转只是错觉，真正的问题是霍尔传感器每60度电角度才跳变一次，而FOC电流环需要每50到100微秒知道转子角度，这个误差直接让Park变换解算出的q轴电流变成噪声。这个工程就是围绕这个问题展开的——STM32做FOC矢量控制，速度模式，霍尔驱动，跑在RTOS上。适合需要把直流无刷电机用在伺服、机器人关节或小型无人机电调上的工程师，也适合刚接触FOC想从源码而不是仿真入手的人。

工程里带着Cortex-M4F的CMSIS-DSP静态库，libarm_cortexM4l_math.a、libarm_cortexM4lf_math.a，说明计算部分已经替你把sin/cos、三角函数优化过了。下面写的内容和这个工程相互印证：霍尔信号怎么变成电角度，电流环怎么和速度环级联，RTOS下任务怎么切，最后给一个验证角度平滑度的调试技巧。

2. 霍尔换向信号怎么变成连续的转子电角度

2.1 霍尔传感器输出与扇区查表

霍尔传感器是开关型输出，三路信号A/B/C按120度电角度安装。转子转过一圈，三路输出会组合出6种状态，每种状态对应60度电角度的扇区。查表是FOC的第一步，也是最容易抄错的一步：不同电机绕线相序不同，霍尔安装位置不同，同一个二进制组合对应的扇区可能不一样。

#define HALL_STATE_1 0x01 #define HALL_STATE_2 0x02 /* 按电机实际相序维护，状态值即 GPIO_IDR 读取到的低三位 */ static const uint8_t hall_sector_table[8] = { 0, /* 0b000 无效 */ 3, /* 0b001 */ 1, /* 0b010 */ 5, /* 0b011 */ 0, /* 0b100 */ 4, /* 0b101 */ 2, /* 0b110 */ 6 /* 0b111 无效 */ };

查表逻辑是把GPIO引脚读到的电平组合当作数组下标，直接拿到扇区号1到6。工程里驱动霍尔传感器的方式是用STM32的GPIO配置成开漏上拉输入，霍尔器件输出引脚自己拉低，不需要额外电平转换。上拉电阻一般在4.7k到10k之间，转速高时上拉电阻过大容易导致边沿变缓，输入捕获的误差会变大。

注意不要在换向瞬间直接读取霍尔状态。霍尔信号跳变沿附近可能因机械安装偏差产生抖动，我一般会在GPIO EXTI中断里加一个3微秒的软件去抖，或者用定时器的输入滤波寄存器，避免在边沿抖动时把错误扇区写入电机控制变量。

2.2 速度计算：用输入捕获测边沿周期

速度模式必须要有速度反馈。常见做法是霍尔信号接到STM32的定时器输入捕获通道，每个边沿触发一次捕获中断，读两次边沿之间的时间差。霍尔边沿在60度电角度产生一次，电机极对数为p时，机械转速计算公式可以写成：

volatile float hall_speed_rpm; void HALL_TIM_CaptureCallback(TIM_HandleTypeDef *htim) { static uint32_t last_count = 0; uint32_t current_count = __HAL_TIM_GET_COUNTER(HALL_TIM); uint32_t dt = current_count - last_count; /* 定时器计数差 */ last_count = current_count; if (dt > 0) { float freq_hz = (float)APB1_TIMER_CLOCK_MHZ * 1000000.0f / (float)dt; /* 每个沿对应60度电角度，转一圈要6个沿，除以极对数得机械转速 */ hall_speed_rpm = freq_hz / 6.0f / (float)MOTOR_POLE_PAIRS * 60.0f; } }

代码里的APB1_TIMER_CLOCK_MHZ是定时器实际时钟，具体数值取决于RCC时钟树和预分频器设置。这个公式的前提是霍尔信号每个沿都代表转过60度电角度，如果极对数为2，转子转一圈有6 * 2 = 12个沿，所以要先除极对数再乘60。参数MOTOR_POLE_PAIRS不是极数，是极对数，工程里电机标称“14极”时这里填7。

转速计算放在捕获中断里做，低频时两次沿之间时间很长，速度更新率会降到几十赫兹。速度环在1kHz执行时，中间大部分周期拿不到新速度，需要用上一拍的速度值或者做软滤波。这个工程里速度环周期是1ms，我一般会在捕获中断里直接更新速度，并同步清掉速度环的任务事件，让RTOS任务立刻读取，而不是等下一次调度。

2.3 扇区内的连续电角度外推

直接查表得到的电角度是一个阶梯波，每个扇区维持60度然后突变。FOC的Park变换要求电角度连续变化，否则d/q轴电流会剧烈抖动量。霍尔FOC工程里的核心技巧是用速度在扇区内积分，把角度从跳变表变成连续值。

float hall_angle_continuous; /* 连续电角度，单位rad */ float motor_elec_speed; /* 电角速度，rad/s */ uint32_t last_edge_time_us; void HALL_OnEdge(uint16_t sector) { uint32_t now_us = hall_timestamp_us(); float dt = (float)(now_us - last_edge_time_us) * 1e-6f; if (dt > 1e-5f) { /* 60度电角度 = PI/3 rad */ motor_elec_speed = (float)MATH_PI / (3.0f * dt); } last_edge_time_us = now_us; } void HALL_UpdateAngleContinuous(uint32_t now_us) { float dt = (float)(now_us - last_edge_time_us) * 1e-6f; hall_angle_continuous += motor_elec_speed * dt; if (hall_angle_continuous >= (float)MATH_2PI) { hall_angle_continuous -= (float)MATH_2PI; } }

这个做法的核心思想是：边沿到达时更新一次角速度，之后在电流环里按匀速外推角度。霍尔边沿之间机械位置发生变化是近似匀速的，速度变化越快，外推误差越大。工程里电流环中断是20kHz，即每50微秒更新一次角度，速度突变时误差还来不及积累，效果可以接受。要注意扇区跳变时角度必须对齐到真实60度分界，否则长时间运行会产生累积相位漂移。

霍尔FOC在低速时比六步换向的优势明显，但对霍尔边沿的准确性也更敏感。霍尔安装偏差会造成边沿时间误差，进而让速度估算出现跳变，表现为电流波形上出现固定的毛刺。

3. 电流环与速度环：Clarke变换到PID参数整定

3.1 为什么电流采样只需要两相

FOC需要得到三相定子电流在αβ轴上的分量，但实际采样只采两相。电机星形连接且中心点不引出时，根据基尔霍夫电流定律，三相电流之和为零。实际工程中采样A相和B相，C相通过计算得到。

void Clarke_Transform(float ia, float ib, float *i_alpha, float *i_beta) { *i_alpha = ia; *i_beta = (ia + 2.0f * ib) * 0.57735027f; /* 1/sqrt(3) */ }

代码里0.57735027f是等幅值Clarke变换系数。等幅值变换下，αβ坐标系的电压幅值与三相相电压幅值一致，这样SVPWM计算时不需要额外缩放。注意这里采样的两相不限于A相B相，也可以采A相C相，关键是在PWM中心对齐时刻采样，此时电流等于一个PWM周期的平均电流。工程里ADC触发信号一般由定时器更新事件产生，采样窗口避开上下桥臂开通瞬间。

参数ia和ib是经过偏置校准后的电流值。霍尔电流传感器的零点偏移会导致Clarke变换结果偏大，我一般上电时采样100次求平均作为零点，运行中再做一次动态校准，否则低速时q轴电流会出现固定偏移，电机会往一个方向微颤。

3.2 帕克变换和电角度的作用

Clarke变换把三相静止坐标变成两相静止坐标，但αβ轴上的电流仍然是交流量。Park变换以转子电角度为旋转基准，把交流量变成直流量，d轴对应励磁分量，q轴对应转矩分量。

#include "arm_math.h" void Park_Transform(float i_alpha, float i_beta, float theta, float *i_d, float *i_q) { float sin_t = arm_sin_f32(theta); float cos_t = arm_cos_f32(theta); *i_d = i_alpha * cos_t + i_beta * sin_t; *i_q = -i_alpha * sin_t + i_beta * cos_t; }

这里的theta就是连续电角度，来自上一章的角度外推。使用CMSIS-DSP库的arm_sin_f32而不是编译器自带的sinf，是因为这个库针对Cortex-M4F做过周期数优化，在20kHz电流环里能节省几十微秒的CPU占用。工程里带的libarm_cortexM4lf_math.a，文件名中的f表示带FPU的M4，l表示小端模式，链接时选择与芯片匹配的那个静态库。

角度误差对FOC的影响比一般人想的大。电角度偏5度，q轴电流解算会损失约0.4%的转矩；偏30度时转矩输出只剩86%，同时d轴会出现去磁电流。霍尔安装偏差容易导致固定的角度偏置，工程里常见做法是让电机空载以恒定速度旋转，观测q轴电流波形，调整角度偏置让q轴电流脉动最小。

3.3 速度环与电流环的级联和PID初值

速度模式通常用速度外环加电流内环的双闭环结构。速度环输出是q轴电流参考值，d轴电流参考值在表贴式电机上直接设为0。电流环应比速度环快5到10倍，一般电流环10kHz到20kHz，速度环1kHz。

速度环的PID实现要注意积分饱和。速度给定时，电机还没到达目标速度之前，积分项会一直积累，等到接近目标时，积分已经超出执行器上限，导致速度回摆。工程里一般把积分输出限制在电流限幅以内，并在输出饱和时停止积分，也就是抗积分饱和。

typedef struct { float Kp; float Ki; float Kd; float integral; float prev_error; float out_max; } pid_t; float PID_Update(pid_t *pid, float error) { float out; pid->integral += error; out = pid->Kp * error; out += pid->Ki * pid->integral; out += pid->Kd * (error - pid->prev_error); pid->prev_error = error; if (out > pid->out_max) { out = pid->out_max; /* 输出饱和时回退积分，避免积分饱和 */ pid->integral = (out - pid->Kp * error - pid->Kd * (error - pid->prev_error)) / pid->Ki; } else if (out < -pid->out_max) { out = -pid->out_max; pid->integral = (-pid->out_max - pid->Kp * error - pid->Kd * (error - pid->prev_error)) / pid->Ki; } return out; }

这个实现里有两个容易忽略的参数：out_max是电流限幅，通常设成堵转电流的一半；微分项对噪声非常敏感，霍尔速度反馈本身有量化噪声，速度环的微分项建议直接置0。工程里速度环只用PI，电流环也可以用PI，微分项在电机控制里主要用于补偿大惯量负载，但参数难整定，新手经常越调越振。

另外，FOC运行时的电流环中断频率很高，PID计算里的浮点运算在Cortex-M4F上很快，但要注意编译时开启硬件FPU，并链接libarm_cortexM4lf这个单精度浮点库，否则全部走软浮点，20kHz中断容易占用超过50%的CPU时间。

4. 引入OS后的FOC任务划分与中断优先级设计

4.1 电流环必须放在PWM更新中断里

工程名里带OS，工程里用的是FreeRTOS。很多人一上来就把电流环放进RTOS任务，周期设到100微秒，实际跑起来发现波形一团糟。原因很简单：RTOS任务调度可能有几微秒到几十微秒的抖动，电流环对时间确定性要求极高，一点点调度抖动都会变成电流噪声。正确做法是电流环完全放在PWM定时器更新中断里，利用PWM中心对齐触发ADC采样，采样完成再触发中断执行FOC计算。

void TIM1_UP_IRQHandler(void) { if (__HAL_TIM_GET_FLAG(&htim1, TIM_FLAG_UPDATE) != RESET) { __HAL_TIM_CLEAR_FLAG(&htim1, TIM_FLAG_UPDATE); Read_PhaseCurrents(); Hall_UpdateAngleContinuous(now_us()); Clarke_Transform(ia, ib, &i_alpha, &i_beta); Park_Transform(i_alpha, i_beta, hall_angle_continuous, &i_d, &i_q); PID_Update(&current_pid_d, d_ref - i_d); PID_Update(&current_pid_q, q_ref - i_q); Inverse_Park_Transform(v_d, v_q, hall_angle_continuous, &v_alpha, &v_beta); SVPWM_Update(v_alpha, v_beta); } }

中断里的代码顺序很清楚：先读电流和角度，再做坐标变换，PID计算，反变换，最后更新SVPWM占空比。中断频率等于PWM频率，工程里设置在16kHz到20kHz之间。Read_PhaseCurrents()读到的电流必须和PWM占空比更新在同一周期内有效，否则一拍延迟会让电流环的相位裕度明显下降。

4.2 RTOS里放什么任务：速度指令、监控、通信

RTOS在FOC工程里主要管理非实时部分，比如速度指令接收、状态监控、上位机通信、堵转保护逻辑。这些任务不需要微秒级响应，放到RTOS里反而清爽。

void vTaskSpeedCmd(void *pvParameters) { int16_t speed_cmd; BaseType_t ret; for (;;) { ret = xQueueReceive(speed_cmd_queue, &speed_cmd, portMAX_DELAY); if (ret == pdPASS) { /* 限幅后写入速度环参考值，PWM中断里只做读取 */ speed_ref_latched = (float)speed_cmd; } } } void vTaskMonitor(void *pvParameters) { uint32_t hall_delta_t; for (;;) { vTaskDelay(pdMS_TO_TICKS(100)); hall_delta_t = get_hall_last_edge_interval_us(); if (hall_delta_t > ROTOR_STALL_US) { /* 霍尔长时间无新边沿，判定堵转 */ fault_code |= FAULT_ROTOR_STALL; } } }

速度指令队列用FreeRTOS队列传递，好处是PWM中断里始终只读普通全局变量speed_ref_latched，而RTOS任务写入这个变量前先做一个临界区保护。监控任务每100毫秒运行一次，检查霍尔边沿时间差，超过预设值就报堵转故障。这种写法把硬实时计算留在中断，把容错和交互放在低优先级任务，系统整体更稳定。

4.3 任务优先级和临界区保护的边界

FreeRTOS里任务优先级需要结合中断优先级统一规划。电流环中断优先级应设为高于任何RTOS可屏蔽中断，这样无论RTOS在做什么，PWM更新中断都能抢到CPU。FreeRTOS运行在BASEPRI寄存器掩码之下，不能阻止真正高优先级的中断。

霍尔边沿中断需要尽快处理，但它的时间不确定性主要来自机械转速。低速时两个边沿间隔可能长达几十毫秒，此时中断频率很低，不占用CPU；高速时边沿间隔变短，最坏情况下20kHz电流环和霍尔中断会竞争。工程里霍尔边沿中断内只更新扇区、时间戳和电角速度，不要做任何滤波计算，滤波放到电流环中断里读。

共享变量保护方面，速度环和电流环都可能访问hall_angle_continuous。我一般用__disable_irq()和__enable_irq()包裹RTOS任务里的短临界区，或者用taskENTER_CRITICAL()。绝不要在FreeRTOS任务里长时间关中断，否则PWM中断的计算会丢失，电机立刻失控。这里的一个可用原则是：PWM中断里不调用任何RTOS API，只更新全局变量；RTOS任务读取这些变量前加临界区，写入速度指令时用队列或者带原子访问的全局变量。

4.4 为什么霍尔FOC比无感FOC更容易跑OS

无感FOC需要反电动势观测器或磁链观测器，这些算法在低速时很难收敛，而且需要占用大量CPU做矩阵运算，留给RTOS的时间很少。霍尔FOC有霍尔传感器提供绝对位置，不需要复杂观测器，所以PWM中断里只有坐标变换和PID，运算量小，CPU有更多余量跑通信和监控任务。这也是这个工程可以在带OS的情况下稳定运行的原因。如果换成无感FOC，建议先优化中断里的浮点计算，再把通讯任务优先级降低，否则偶发的调度延迟会让无感观测器发散。

5. 把电角度“看”出来的调试技巧

5.1 用DAC输出角度曲线

霍尔FOC最麻烦的问题是电角度不连续。肉眼看不到内部变量，只看电流波形很难判断是角度外推错误还是PID参数问题。工程里低成本做法是用STM32的DAC输出电角度，把0到2π映射到0V到3.3V，然后用示波器观察。

void Debug_OutputAngle(float angle_rad) { uint16_t dac_value = (uint16_t)(angle_rad * DHR12R_FULL_RANGE / 6.28318f); __HAL_DAC_SET_VALUE(&hdac, DAC_CHANNEL_1, DAC_ALIGN_12B_R, dac_value); }

正常匀速运行时，DAC输出应该是一条锯齿波，每个霍尔扇区一次锯齿回复。如果看到扇区内角度往回跳、增速不匀、或者扇区边界出现毛刺，说明外推角度没有和霍尔边沿对齐。代码里的DHR12R_FULL_RANGE是DAC 12位分辨率时的满量程值，STM32F4系列是4095，映射比例可根据DAC参考电压微调。

5.2 扇区突变时的环绕补偿

角度外推到0和2π边界时，一小步计算误差就可能让角度从359度跳回1度，造成速度和电流突变。调试时尤其容易遇到这种情况。

float Angle_AddWithWrap(float angle, float delta) { angle += delta; if (angle > (float)MATH_2PI) { angle -= (float)MATH_2PI; } else if (angle < 0.0f) { angle += (float)MATH_2PI; } return angle; }

单独看这个函数很简单，但实际工程里霍尔扇区更新和角度外推是两个不同中断，一旦时间戳错乱，角度可能连续两次回绕。我调试时会在DAC输出上加一个方向标志：正转时角度递增，反转时递减，反转过零时DAC波形从接近0V跳变到接近3.3V，这样在示波器上很容易区分正常回绕和异常抖动。另一个常用做法是记录每个扇区的进入时间，与角度外推速度做交叉校验，如果同一扇区停留时间明显短于边沿周期，就说明角度更新逻辑里有重复计数。

5.3 低速堵转检测的关键参数

霍尔FOC在低速时边沿间隔很长，堵转时完全没有边沿。堵转检测不能靠速度值本身，而要看边沿间隔是否小于堵转阈值。把这个判断放在RTOS监控任务里，100毫秒采样一次，比放在霍尔中断里更合理。阈值建议设为电机额定转速对应边沿间隔的3到5倍。比如额定3000转电机、极对数为4时，额定转速下的霍尔沿频率约300Hz，堵转阈值可以设在100Hz对应时间。如果环境振动大，可以再加一次确认，连续两次检测到超时再报故障，避免启动瞬间误报。

调试霍尔FOC不能只盯转速波形，要把电角度、d/q轴电流、速度环输出同时录下来。这一套工程里最值得抄的就是角度外推和任务划分，把实时计算留在中断，把逻辑判断交给RTOS，整个系统才有余量去处理通信和故障。

本文还有配套的精品资源，点击获取