STM32双电机FOC霍尔驱动工程详解：双触发采样与FreeRTOS实战

简介：本资源是一套基于STM32平台的直流无刷电机（BLDC）双电机FOC矢量控制完整工程，面向嵌入式电机控制开发者、高校电赛/毕设学生及工业驱动工程师，解决高精度、实时性要求下的多电机协同控制难题。压缩包含1191个文件，主体为655个C源码与367个头文件（实现FOC核心算法、霍尔位置解算、双电机PWM同步、OS任务调度等），辅以78个汇编启动文件、46个IAR链接脚本及数学库文件（如arm_cortexM4lf_math.a、dct4_init_f32.c等），整体31.43MB，结构清晰，模块化程度高。已有1697人学习下载，可直接导入IAR或Keil环境编译运行。读者将获得带FreeRTOS（或类似轻量级OS）的双电机独立FOC闭环代码、霍尔传感器实时换相逻辑、克拉克/帕克变换与PI电流环实现、以及完整的硬件外设（TIM/PWM/ADC/GPIO）驱动配置范例，是深入理解磁场定向控制工程落地的高质量实践样本。 前阵子我把一套双电机FOC的工程整理打包分享出去，标题叫“STM32实现FOC_双电机控制_霍尔驱动_带OS”。陆陆续续有人加我聊：这个zip里到底有什么？霍尔做FOC是不是性能不行？带OS跑电机控制会不会影响实时性？代码能不能直接改成自己的板子用？我干脆把这套项目从压缩包变成能转的电机、能跑的小车过程中，真正会遇到的细节一次写清楚。按当时排查和调试的顺序来，代码里对应的关键词——双触发、双电阻采样、霍尔扇区、有效磁链、CORDIC——都会在对应的位置出现，省得你翻代码时对不上。

先给个判断：这套方案的目标不是极致性能，而是“双电机同步控制不出乱子”的工程化实现。霍尔传感器解决的是启动和低速时的转子位置问题，FreeRTOS解决的是通信、状态机、监控这些非实时任务和电流环之间的资源冲突问题。适合正在做机器人底盘、云台、双轴转台、家电风机控制的开发者参考。如果你手里一份代码都跑不起来，那我建议你先把ST官方的电机控制库玩明白，再回来看这个工程，否则你会被里面互相咬合的模块劝退。

1. 解压之后先看什么：目录结构与快速上手指引

这类zip包我收了不少，也发了不少，最怕的就是解压完不知道从哪里开始看，对着几百个文件发呆。这个包我重新整理过目录，故意把每个模块拆开，而不是塞成几个巨大的main.c。拿到压缩包，先按这个顺序过一遍目录：

Project/ ├── Doc/ # 原理图PDF、霍尔相序说明、调试记录 ├── Drivers/ │ ├── STM32G4xx_HAL_Driver/ │ └── BSP/ │ ├── hall.c/.h # 霍尔信号读取、换相表、测速 │ ├── adc_driver.c/.h # 双ADC采样、DMA搬运、电流重构 │ ├── pwm_driver.c/.h # TIM1/TIM8互补PWM、死区配置 │ └── current_sense.c # 双电阻采样电流计算 ├── Motor/ │ ├── foc.c # Clark/Park变换、PI调节器 │ ├── svpwm.c # SVPWM算法 │ ├── hall_foc.c # 霍尔扇区角度估算与切换 │ └── motor_ctrl.c # 电流环/速度环状态机 ├── RTOS/ │ └── FreeRTOS/ # 内核源码，没动过 └── User/ ├── main.c ├── tasks.c # 任务创建与优先级 └── protocol.c # 串口/上位机通信

如果你从零开始读这套代码，我建议看的顺序是：Doc里的原理图，再开Motor/motor_ctrl.c，然后看hall_foc.c，最后才碰adc_driver.c和pwm_driver.c。先看FOC主循环的人最容易懵，因为电流环只有在ADC中断里才跑，主循环里根本看不到电机控制的影子。这个工程和课本上那种while(1)里调FOC的Demo不一样，控制代码全部挂在中断和RTOS任务里，主循环只是一个创建任务的大壳子。

硬件上主控建议选择带高级定时器和双ADC的型号，这个工程默认就是按这种资源量写的。如果你用的是F103这种老平台，也不是不能跑，但双电机双电阻采样加上霍尔测速加FreeRTOS，定时器和DMA通道会非常紧张，基本要把外设资源的账算到极致。能上G4或者F405级别，编程体验会舒服很多。包里CORDIC相关的代码是G4专用加速项，其他型号直接编译会报错，这部分我已经用宏隔离过了，你可以在foc.c里搜USE_CORDIC把它关掉。

上电之前还有一件重要的事：把Doc里的霍尔相序表和你的电机线序对一遍。霍尔UVW和电机三相UVW如果接错，电机状态机在启动阶段就会发出尖锐鸣叫，然后电流飙升触发过流保护。这个不是代码问题，是硬件接线问题，调试器帮不了你。

2. 双电机霍尔FOC的方案取舍：为什么不是无感，也不是编码器

很多人看到“霍尔”两个字就默认这是低端方案，直接问“不能上无感FOC吗”“不能加磁编码器吗”。无感FOC确实香，中高速性能好，零成本增加传感器，但有一个致命弱点：零速和极低速时反电动势几乎为零，转子初始位置估不出来，必须依赖开环强拉或者高频注入。双电机场景下，如果两个电机在启动瞬间都处于未知位置，你又想让它俩同步走，开环强拉环节会让位置失控，轻则小车跑偏，重则启动电流直接顶到限幅值。霍尔传感器完美补上这个短板：上电一瞬间读出霍尔电平，直接确定转子所在的60°扇区，虽然误差有正负30°电角度，但足够让电流环在闭环状态下把转子拖到目标位置。

磁编码器（比如AS5600）精度确实高，零点几度的角度误差，FOC跑起来电流波形漂亮得多，扭矩波动也小。但代价是每个电机多一条SPI或者I2C总线，双电机就是两路，板子布线复杂，成本也上去了。很多场景——比如两轮差速小车、家用风机、水泵——根本不需要那么高的角度精度。霍尔FOC在50%额定转速以下的表现足够用，扭矩波动虽然比编码器明显一点点，但换来的成本和结构简化非常可观。这个工程选霍尔，不是做不了无感，而是把“双电机同步控制”这个核心目标放在第一位，把系统复杂度压下来。

还有一点可能被忽略：霍尔传感器不光给角度，还能直接测转速。霍尔信号每个电周期有6个边沿，每个边沿都是一个天然的测速点。速度环需要的转速反馈可以从同一组霍尔信号里算出来，完全不需要额外的测速传感器。这就意味着霍尔FOC是“一个传感器，干了位置和速度两件事”。无感FOC的速度是从角度微分或观测器里估的，低速时噪声大，速度环带宽上不去；霍尔因为直接测量机械位置，速度反馈在低速时反而比无感更干净。

我实际做下来，这个工程的稳态效果是这样的：额定转速3000rpm的电机，霍尔FOC跑到1500rpm以下，速度波动控制在正负5rpm以内，电流波形里有一些60°电周期的脉动，但不会影响双电机同步。转速超过额定50%以后，霍尔边沿之间的角度外推误差开始变大，这个时候霍尔信号反而不是主角了，角度估算主要靠速度积分加上霍尔边沿周期校正。如果项目对高速性能要求很高，建议把无感观测器（比如有效磁链法）作为高速段的辅助，霍尔负责启动和低速。这也是很多量产方案的真实结构。

3. 霍尔信号怎么变成连续电角度：扇区、测速和角度外推

这是整个工程里最容易写错、也最容易调疯的部分。霍尔传感器输出三个方波信号，组合起来有8个状态，其中6个有效状态对应转子所处的6个电角度扇区，每个扇区正好60°。只要电机在转，霍尔状态就按固定顺序跳变，这个顺序就是换相表。换相表本身不难，难的是两个坎：一是换相表顺序和电机实际线序的对应关系，二是霍尔状态只告诉你“在哪个扇区”，没告诉你“扇区内的准确角度”。

先解决线序问题。接好线之后写一个测试程序，让电机处于自由状态，手动慢慢转动电机，每变化一次霍尔状态就打印一次当前状态值和对应的电角度。转一整圈，你会得到一组状态序列，比如1-3-2-6-4-5。把这个序列存成数组，FOC运行时根据当前霍尔状态直接查表得到扇区起始角。如果正转和反转的序列反了，把数组倒过来就行，不需要改硬件。这个包里的hall.c有一个HALL_GetSector()函数，返回0到5的扇区号，再用扇区号算电角度：theta = sector * 60 + 30，单位是电角度，取扇区中心作为初始估计值。这样一来上电瞬间就有角度了，虽然最大有正负30°误差，但FOC电流环能容忍这个误差把转子拉正。

然后是测速。霍尔信号每进入一个新扇区，说明转子转过60°电角度。用定时器记录相邻两次扇区跳变的时间间隔ΔT，转速就是：

电角速度 ωe = (π/3) / ΔT 机械转速 n = ωe / P × 60 / (2π) = 10 / (P × ΔT)

P是电机极对数，ΔT单位是秒，n是每分钟转速。这个公式我在调试笔记里反复用过，实测和光电测速计的结果基本对得上。低速时霍尔状态变化慢，单次ΔT很大，测速反馈更新率低，速度环容易迟滞甚至震荡。所以这个工程里速度环做的不是纯M法，而是低速时在一个固定时间窗口内数霍尔边沿个数（相当于T法），高速时用边沿间隔，二者平滑切换。切换点大概在转速的5%附近，代码里SPEED_CALC_THRESHOLD这个宏就是干这个的。

扇区内的连续角度靠外推。原理很简单：两个霍尔边沿之间，用上一次的转速估算值对角度做斜坡积分：

theta += omega * dt;

每当霍尔边沿到来，就用新的扇区起始角把theta拉回来，同时做一次低通限幅，防止角度阶跃太猛导致电流突变。这个外推在低速时精度一般，但好处是角度永远不会累积漂移，因为每60°就被霍尔硬校正一次。中高速时因为外推时间短，角度误差很小，FOC性能主要取决于测速准不准。如果你看到电机高速运行时电流波形出现规律性尖刺，十有八九是这里的外推增益没调好。

还有一点提醒一下：霍尔信号是开关量，从驱动器到MCU的长线上容易耦合功率级的开关噪声。纯靠EXTI边沿中断触发角度校正在强干扰场合不够稳，我后来改成定时器周期性扫描霍尔状态并记录变化时刻，同时加一个RC滤波和施密特整形。代码里保留了EXTI的版本，用宏HALL_USE_EXTI切换，但新板子我全部用扫描方式了。如果你发现转速反馈乱跳、角度校正频繁误触发，先怀疑霍尔信号质量，别急着调PI参数。

4. 双电机电流采样的“双触发”机制：同步采样的时序设计

双电机FOC和单电机最大的区别，就是两个电流环必须在同一个时间基准上运行。如果1号电机在PWM中心点采样电流，2号电机在PWM边沿采样，那你在上位机上看到的两个电流波形会在时间上错开几十微秒。这个错开在单机调试时看不出来，双电机一起跑同步性测试时，位置环和速度环会互相“打架”，表现出周期性抖动。所以这个工程的核心设计之一就是：两个PWM定时器同步，两个ADC在同一时刻被触发采样，中断里同时完成两个电机的FOC计算。

具体实现是这样的。TIM1和TIM8分别驱动1号电机和2号电机的三相全桥，两个定时器配置为中心对齐模式，周期都是20kHz。TIM1配置为主模式，通过ITRx信号把同步事件发给TIM8，让TIM8跟着TIM1的周期走，保证两个PWM载波完全同相。在TIM1和TIM8的周期中断（或者更新事件）里，分别产生TRGO触发信号，各自触发ADC1和ADC2的注入组开始采样。因为两个定时器已经同步，两个ADC的采样触发时刻也就自然对齐了。这就是搜索关键词里“foc双电机采样组扫描双触发”的实际含义——两个ADC各自有独立的采样触发源，但触发源是同步的，所以等效于双通道同时采样。

每个电机用双电阻采样，也就是只在PWM周期内采集两相电流，第三相电流用基尔霍夫电流定律算出来：i_c = -i_a - i_b。难点是采样窗口。中心对齐PWM模式下，上下桥臂在计数器顶点附近处于稳定的导通状态，这时采样最可靠。但这个窗口的宽度受调制比限制：调制比接近1时，某些扇区里某一相的采样窗口会变得非常窄，甚至小于ADC采样保持时间。解决办法是缩小采样电阻的滤波时间常数，同时把ADC采样时间配置到最小（比如1.5周期），必要时对这个扇区做采样点偏移。这个包里adc_driver.c里的ADC_TRIGGER_SHIFT参数就是干这个的，实测能覆盖到95%左右的调制比范围。

再说DMA。两个ADC各自开注入组，转换结果通过DMA搬运到内存，而不是在中断里轮询读取数据。ADC1的注入组序列包含相A和相B两路电流，ADC2同理，DMA每完成一次完整搬运就产生一次传输完成中断。在这个中断里，两个电机的电流值都已经就位，直接开始算Clark变换、Park变换、电流PI、反Park变换、SVPWM，然后更新两个定时器的比较寄存器。整个计算必须在PWM周期剩余时间内完成，20kHz对应的周期是50μs，STM32G4在170MHz主频下两个电机的FOC全部算完大概20到25μs，留了一半余量给中断开销和RTOS调度。

你需要特别小心的是采样触发点和死区的关系。死区时间内桥臂状态不确定，绝对不能采样。硬件上采样滤波器的截止频率不能太低，一个经验值是把滤波时间常数控制在1μs以内。如果发现电流波形在过零点附近出现毛刺，先看是不是采样点落在死区边缘了。软件上还可以做死区补偿，但优先把采样窗口调对，补偿只是备选方案。

关于“双触发”，还有一个小细节：两个ADC如果用同一个触发信号同时启动，理论上没问题，但实际因为ADC内核有采样保持电容，两个ADC同时转换同一个母线电压时会有微小的串扰。我测下来影响不大，但如果你追求极致一致性，可以把两个ADC的采样点错开几百纳秒，这个时间差对FOC来说完全无感。

5. FreeRTOS进入电机控制：任务划分与中断优先级的边界

“带OS”这三个字让很多人紧张，觉得RTOS会把FOC的实时性搞坏。我的观点相反：双电机FOC这种系统，裸奔比带OS更容易出事。你不带OS，ADC中断里做完FOC，主循环里还要处理串口命令、霍尔状态扫描、故障灯闪烁、上位机回传数据。只要其中一个阻塞一下，下一个PWM周期的电流环就可能延迟执行，电机立刻发出异响。OS做的不是让实时性更好，而是把“非实时事情”和“实时事情”隔离开，让实时部分永远不被非实时部分拖累。关键在于怎么划分任务，以及优先级和中断抢占边界怎么定。

这个工程的RTOS任务划分是这样的：

注意一个原则：FOC的电流环绝对不在任务里跑，而是在ADC中断里跑。中断和任务之间靠二值信号量同步。具体流程是：ADC中断做完电流环之后，把一个信号量交给MotorControlTask；这个任务被唤醒后读取当前转速、计算速度环输出，把新的Iq参考值写回给中断专用变量。速度环周期是1ms，电流环周期是50μs，两者之间差了20倍，用信号量做握手很顺。

FreeRTOS本身不产生抖动吗？会，但可以控制。你要把FOC相关中断的优先级设为高于configMAX_SYSCALL_INTERRUPT_PRIORITY，也就是这些中断里绝不能调用任何FreeRTOS API。ADC中断里只做数学运算和寄存器读写，最多用一个portYIELD_FROM_ISR触发上下文切换，但这个宏也只是设置一个标志，不会真正阻塞中断流程。这样FreeRTOS的调度器对电流环来说就是个透明的东西，它该优先级抢占就抢占，但永远抢不到ADC中断头上。

任务里还有一个坑：多个任务同时访问电机控制参数，比如调速指令、使能标志。裸机里你随便改个全局变量就行，带了OS就要考虑并发。这个工程统一用taskENTER_CRITICAL短临界区保护，每个临界区只做一件事：要么读速度参考值，要么写状态字。千万别在临界区里做通信或打印，那会把中断关太久，直接导致FOC电流环周期性丢步。

优先级的具体设置建议按这个原则来：速度环任务最高，因为它直接影响稳定性；通信任务其次，因为它需要及时响应上位机指令；日志和监控任务放最低。故障保护要单独说，硬件过流保护必须在比较器或者逐周限流电路里完成，绝对依赖OS任务，那是灾难。这个包里的逐周限流用的TIM_BDTR寄存器刹车功能，一旦过流比较器翻转，PWM立即全部断开，任何软件都干预不了，这才是正确的保底方案。

6. 最不好调的环节：启动过程、限流与保护逻辑

启动阶段是双电机FOC出问题最多的地方。单电机启动不顺，顶多电机抖一下；双电机如果启动逻辑写得糙，两个电机会在电流限幅附近反复拉锯，母线电压被拉垮，然后两个一起过流保护。这个工程里启动流程是按“初始定位——I/f强拉——闭环切换”三段来写的。

初始定位很简单，霍尔上电就能读出扇区，直接用扇区中心角作为电角度。这里的正负30度误差在带轻载时没问题，但带重载时可能启动瞬间反转一下。如果你发现电机上电时总往回倒一点，就把启动电流矢量的角度加一个偏置，让初始力矩方向更贴近实际转子位置，实测能明显减小反转角度。反正霍尔只有6个扇区，找出每个扇区最合适的启动偏置并不难，放到一个数组里，启动时查表就行。

I/f强拉是霍尔FOC启动的核心。给定一个恒定的电流幅值，让电流矢量的角度从一个起始值匀速递增，相当于一个虚拟的“旋转磁场”，把转子硬拖起来。这个阶段的转速是开环的，所以我通常叫它“强制换向”。强拉过程中霍尔信号会一直对角度做校正：每个扇区边界，把虚拟角度拉回霍尔给出的扇区真实角度，这样即使负载有波动，角度也不会漂太多。强拉加速度要按负载惯量去标定，加速度太大会出现失步，电机突然顿住然后反转；太小又太慢，没法满足快速启动要求。我的建议是从额定转速的5%每秒开始标，逐步加大到10%，看电机响应来判断合不合适。

闭环切换的判据是速度估算值是否稳定。强拉阶段霍尔测速已经在跑了，等估算转速接近目标转速的80%左右，并且速度波动连续100ms以内不超过正负3%，就可以把电流环参考值从“虚拟电流矢量的幅值”切换到“速度环输出的Iq”，同时把I/f的虚拟角度丢弃，完全交给霍尔外推角度。切换瞬间注意幅度突变：I/f强拉时的电流幅值如果比速度环需要的Iq大很多，切换后电机会突然减速。所以切换前要把I/f的电流幅值斜坡降到接近速度环的期望值附近，再做切换，这样切换冲击几乎感觉不到。

限流和保护逻辑的层级顺序是这样的：第一道是硬件逐周限流，TIMx_BDTR配置好刹车输入，过流比较器翻转，硬件立刻封波。第二道是ADC中断里的软件过流判断，每个PWM周期都检查三相电流的合成幅值，超过阈值就挂起PWM输出并置位故障标志。第三道才是RTOS任务里的慢保护，比如过温、母线过压欠压、堵转判定。堵转判定有个细节：用速度环的输出持续饱和作为判据，而不是直接用转速为零判断。电机带载爬坡时转速可能只有几十转，直接判零会误触发；速度环饱和代表已经给到最大力矩还提不上速，大概率是真的堵了。

这里还要提一个“有效磁链”的问题，因为很多人问过。霍尔FOC在中低速时角度已经够用，不需要算有效磁链。但如果你的项目要把转速往上推，霍尔角度外推在高转速下误差变大，就需要用有效磁链观测器来估算反电动势和转子角度。有效磁链的本质是从电机数学模型里提取永磁体磁链在定子坐标系下的分量，再求反正切得到角度。它不需要知道转子初始位置，但需要一个准确的电机电感参数。这个包里预留了flux_observer.c的接口，默认没启用，属于高速段增强选项，不是基础依赖。

7. 实测中遇到的三个坑：换相噪声、地弹采样、双机互扰

调试这套双电机系统，前后花了将近两周，大部分时间不是耗在FOC算法本身上，而是耗在各种“看起来很怪”的硬件现象上。挑三个典型问题说，每个都是不遇到一次很难想到的。

换相噪声导致角度校正乱跳。现象：低速运行时电流波形周期性出现毛刺，转速反馈在设定值附近跳来跳去，角度波形在扇区切换点有明显毛刺。一开始以为是PI参数问题，把电流环带宽从2kHz降到1kHz也没改善。后来用示波器量霍尔信号，发现每个换相边沿都有严重的振铃，边沿前后还叠加了PWM开关噪声。霍尔线太长，又没有滤波，EXTI中断被噪声反复触发，每次触发都会给角度估算造成一次误校正。解决办法是硬件上霍尔线加RC滤波，引脚改成定时器扫描方式读取，软件上对霍尔状态变化做消抖判断——只有连续N次扫描到同一个新状态才认定换相。这个N在慢速电机上可以取大一些，我最后取的是8次扫描周期。

共地地弹导致ADC采样值周期性跳变。现象：两个电机都在转的时候，电流环没问题，但母线电压采样值波动高达几百毫伏，导致SVPWM的过调制判断频繁误触发，电压利用率下降。查了一圈发现是功率级大电流从母线回流时，在PCB地线上产生了地弹噪声，ADC的参考地跟随一起跳动，采到的“精确电压”全是假数据。解决办法是PCB改版时把功率地、信号地、模拟地做了单点汇流，减小大电流回路面积；软件上对母线电压采样结果做了移动平均滤波，并且把采样时刻从PWM边沿附近挪到PWM顶点附近，避开IGBT/MOS管开关瞬间的di/dt尖峰。改完之后母线电压波形干净了很多，SVPWM过调制判断也正常了。

双电机共母线导致的电流环互相干扰。现象：1号电机稳定运行，2号电机一启动或者负载突变，1号电机的电流波形立刻出现一个几十毫秒的扰动，转速也有轻微波动。这其实是电源侧的耦合：两个电机共用直流母线，2号电机负载突增时母线电压瞬间跌落，1号电机的电流环输入端根本没收到这个电压变化，但它输出的PWM占空比没变，实际电流就跟着母线电压一起跌了，随后电流环才慢慢把电流拉回来。这个延迟就是扰动来源。解决思路分两层：硬件上在母线电容处并一个陶瓷电容阵列，提高高频响应能力，减小瞬态电压跌落幅度；软件上把两个电机的电流环采样触发点严格对齐，让它们在同一时刻看到母线电压的变化，然后通过前馈补偿把母线电压变化量直接映射到PWM占空比上，减少电流环的调节负担。第二层改动量不大，但在双电机同步应用里效果立竿见影。

这三个问题有一个共同点：都是“硬件现象，软件解决，但根源在硬件设计”。如果你在调试中遇到类似情况，别急着怀疑代码，先用示波器看波形，把问题定位到源头，再决定是改板还是打补丁。很多双FOC工程调不稳，不是算法不行，而是采样链路被干扰污染了，算法拿到的全是脏数据。

8. 移植到自己的板子：你需要改动的地方和验证清单

很多读者拿到这个包，第一反应是“把电机接上，烧录跑起来”。如果你用的板子和我这套原理图完全一样，那可以；但现实是大部分人要改引脚、改定时器、改采样电阻参数。这里我按改动量从小到大列一份清单。

第一优先级：GPIO引脚和定时器映射。霍尔三个输入引脚、PWM输出引脚、ADC采样引脚，这些在工程里都集中在bsp_pin.h一个文件里，直接按你的原理图改宏定义就行。最容易错的是霍尔输入和调试接口的冲突——如果霍尔信号占用了PB3、PB4或者PA15，必须先把JTAG释放掉，否则调试器和霍尔信号会打架。这个网上踩坑的人很多，我在包里的README也写了：主控选型时避开这几个引脚。

第二优先级：PWM频率和死区时间。默认20kHz载波、1μs死区。如果你的功率管是MOS管，死区可以小一点，比如500ns；如果是IGBT，死区要放到2μs以上。死区太小会上下直通，太大电流波形失真，需要根据实际驱动芯片的手册调。注意改PWM频率后，ADC采样触发点和中断里的FOC计算时间预算都会变，20kHz下50μs的周期是宽裕的，如果你提到40kHz，那单次FOC计算就必须压到25μs以内，G4没问题，F103就要精打细算了。

第三优先级：电流采样增益和偏置。双电阻采样一般经过运放放大后进ADC，运放的放大倍数和分压偏置直接决定电流环的标度。current_sense.c里的CURRENT_SENSE_GAIN宏要按你的硬件换算：如果电机的最大相电流是10A，你希望满量程对应3.3V，那放大后的电压标度就是0.33V/A，把这个数值填进去。这个参数错了，FOC的PI参数全都会变，电流环必然发散。测试方法就是给电机一个固定Iq命令，用电流钳实测相电流，跟代码里算出来的值对比，标定误差控制在2%以内。

第四优先级：电机参数和极对数。FOC的PI初始参数来自电机电感和电阻的估算。motor_param.h里的相电感、相电阻、极对数、额定电流、额定转速都必须填真实值。极对数填错最直接的现象就是电角度和机械角度不匹配，霍尔换相顺序全乱，电机根本无法正常旋转。如果你不知道极对数，可以手动转电机一圈，记录霍尔状态循环的次数，那就是极对数。相电感和相电阻可以用LCR表测，没有的话就用低频正弦波激励电机，通过电流幅值和相位关系反推，网上有现成方法。

验证清单按这个顺序走，能少走弯路：

1. 霍尔信号测试：手动转电机，上位机或串口打印霍尔状态序列，确认6个扇区都能读到且顺序正确。
2. 电流标定测试：锁定转子不让电机转动，给一个很小的Iq指令，用钳表对比实际电流和代码计算值，确认增益无误。
3. 单电机电流环闭环：PWM输出、ADC采样、电流PI全通，目标Iq从0逐步加大，观察电流跟随情况，确认无振荡。
4. 单电机速度环闭环：速度环切入，给一个目标转速，观察启动、加速、稳态过程，确认无过大超调。
5. 双电机同步运行：两个电机同时给一个速度斜坡指令，观察两个速度反馈的跟随误差，确认双触发采样正常。
6. 故障注入测试：人为把某根霍尔线拔掉，确认故障保护能及时封锁PWM，而不是等电机失控才动作。

这六步全过，你的双电机霍尔FOC基本就站住了。我自己在移植到另一块控制器上时，前四步花了一下午，第五步和第六步又花了一天，主要时间都耗在采样噪声和霍尔信号质量上。如果你用的是比较杂牌的电机，霍尔相序表可能需要多试几次，换相表本来就是一次性的活，调好之后就不会再动了。

最后说一个个人体会：这套工程的设计哲学是“能用传感器解决的，就不硬啃算法”。霍尔让双电机FOC的初始位置问题变得极其廉价，FreeRTOS让任务的边界变得清晰，双触发采样让两个电机共享一个时间基准。你在自己的项目里也可以这样思考——先用最稳妥的传感器方案把系统跑通，再用观测器和优化算法去替代硬件，而不是一上来就挑战高难度。等你把这一套玩熟了，再往无感FOC、更低成本的方向演进，心里会踏实很多。

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