简介：面向电机控制入门者及低成本驱动器开发者，这是一套基于STM32F030实现4kHz电流环FOC的完整工程源码。项目参考simpleFOC并借鉴ST电机库架构，将主控从G431降为F030，采用浮点计算，单周期电流环耗时约230us，控制效果偏向验证性质，但完整呈现出在ADC采样完成中断中执行FOC的代码路径，包括编码器Z相校准、电角度计算、Clarke/Park变换、低通滤波、PID运算及SVPWM占空比生成，为后续定点化优化和频率提升提供了可移植的基线。资源共946个文件，以C/C++源码（572个c、258个h）为核心，辅以启动汇编（57个s）、IAR与CubeMX工程配置（uvprojx、icf、ioc等）及少量库文件，压缩包约16.52MB，目录结构清晰，便于按模块阅读。目前已有3056人学习浏览，适合需要把FOC电流环落到Cortex-M0低成本芯片上的开发者参考借鉴。
1. 基于stm32f030的4kHz电流环FOC控制程序：一个被低估的工程基准配置
基于stm32f030的4kHz电流环FOC控制程序，乍看是个普通项目标题，细想却是一套很实在的选型约束：主频48MHz、M0内核无硬件浮点、片上只有一个12位ADC，却要把电流环跑到4kHz并保证不炸管。这个组合在低成本风机、水泵、小型伺服和电动工具里很常见，也是很多工程师从“抄一段FOC代码”走向“自己调得动电流环”的必经台阶。做这类项目不需要复杂的观测器和弱磁控制，但4kHz电流环是整套系统的命根子——电流环扛不住，后面的速度环、位置环、无感FOC全是空中楼阁。
2. 为什么把电流环定在4kHz：带宽、PWM载波和F030的资源账
2.1 4kHz采样率能撑起多大的电流环带宽
电流环本质是一个数字化的PI调节器，采样率决定了带宽上限。工程经验上，电流环闭环带宽通常取采样频率的1/10到1/20，4kHz采样对应当前环带宽大约200到400Hz。这个数字听起来不高，但对F030这个级别的器件，拖动一台500W以下的PMSM或直流无刷电机已经够用。追求电流环大带宽是好事，但要把账算清楚：采样率往上提，数字控制引入的延迟占比就变大，相位裕度被吃掉，表现出来反而是电流尖峰和啸叫。
限制电流环带宽的三笔延迟账：PWM比较值更新延迟、ADC采样保持时间、PI调节器计算时间。三者叠加通常在1.5到2个采样周期。这就是为什么不能拿采样率直接当带宽用。理解FOC控制中带宽的关键，不在于把PI增益调到最大，而在于搞清楚延迟在哪里、相位裕度还剩多少。
2.2 F030的资源账：48MHz、无FPU、单ADC
STM32F030没有硬件浮点单元，4kHz中断里如果放开用float运算，每次中断要做Clark、Park、两个PI和SVPWM，瞬时负载可能冲到3000周期以上。算一笔账就清楚：48MHz主频，4kHz中断，每个周期可用指令约12000条。用定点数实现整个电流环，大约只需要800到1500周期，余量非常宽裕。
所以4kHz对F030来说不是天花板，而是定点化实现下的舒适区。这类程序通常会把电流归一化到Q15格式，把sin/cos换成查表，把PI的除法换成移位。另一个硬件约束是F030只有一路ADC，无法同时采样两相电流，只能顺序采样两路，产生一个固定时间差。这个误差在4kHz下约1到2微秒，对电流环PI来说可以接受，但要心里有数。
2.3 PWM载波和电流环频率怎么搭配最合理
常见做法有两种：PWM 8kHz配4kHz电流环，或者PWM和电流环都定在4kHz。我一般选前者。原因是TIM1中心对齐模式下，定时器先增后减，一个完整周期里有上溢和下溢两个事件，下溢点正好是PWM周期的中点，此时相线电压处于零电平附近，采样点最安静。
中心对齐模式下PWM频率的计算公式是：f = 主频 / (2 × (ARR + 1))。48MHz主频下要得到8kHz PWM，ARR设为2999。电流环4kHz的意思是每两个PWM周期执行一次电流环中断，也就是在下溢事件触发采样和控制计算。直接让PWM等于4kHz也能跑，但开关纹波会明显变大，对采样电阻上的信号调理要求更高。这个“PWM频率和定时器计数方向”的关系，是理解FOC PWM波形和定时器配置的关键。
2.4 为什么不是10kHz或20kHz
很多现成的FOC方案跑在10kHz甚至20kHz电流环，那是给带FPU的MCU准备的。F030的Flash和RAM都有限，8KB RAM要放电流环状态、PI参数、SVPWM查表，还要给速度环留空间。10kHz意味着中断周期100us，可用指令数缩到4800条，还要在同样时间里多跑一轮控制计算，已经接近这个内核的极限。
反过来看，很多应用场景根本不需要那么高的电流环带宽。一个响应时间在2ms级别的速度环，搭配300Hz左右带宽的电流环，带载能力和抗扰性能都够。关键是先让4kHz电流环在F030上稳定跑起来，再考虑要不要往上挤。
3. 从定时器到SVPWM：把4kHz电流环拆成五个落地步骤
3.1 第一步：TIM1中心对齐模式与互补PWM输出
F030里的TIM1是高级定时器，带互补输出和刹车输入，天然适合驱动三相全桥。配置要点是把计数器模式设为中心对齐1，ARR设为2999，得到8kHz PWM，占空比比较值由SVPWM计算后写入TIM1的通道比较寄存器。
互补PWM必须配置死区时间。死区的作用是防止上下桥直通，但不能设太大，因为死区期间相线电压处于不确定状态，会把电流波形压出非线性。F030的DT寄存器以定时器时钟为步进，48MHz下每个步长约20.8纳秒，0.5微秒死区大约需要24个步进。对低压小功率驱动器，0.3到0.8微秒是常见区间。
3.2 第二步：让ADC在正确的时刻采样
电流采样要踩准PWM的“安静窗口”。中心对齐模式下，定时器计数到0时所有下管导通或处于死区，相线电压接近0V，这是最好的采样点。配置TIM1的更新事件作为ADC触发源，ADC在PWM下溢时刻启动转换。
F030只有一路ADC，要采两相电流就得顺序转换两次。这里有个先后关系：先采A相，再采B相，两次转换之间有固定延迟。4kHz电流环下，这个延迟占比约1%，PI调节器完全能吸收。但要注意，不能让ADC采样发生在PWM边沿附近，否则开关噪声会直接灌进电流波形，表现为等间距毛刺。
TIM_MasterConfigTypeDef mstr = {0}; mstr.MasterOutputTrigger = TIM_TRGO_UPDATE; // 更新事件作为ADC触发源 HAL_TIMEx_MasterConfigSynchronization(&htim1, &mstr);这段配置的意思是让TIM1的更新事件输出触发信号，接到ADC1的硬件触发引脚上。这样电流环的采样时刻由硬件保证，与中断响应延迟无关，抖动控制在纳秒级。
3.3 第三步：Clark变换、Park变换与定点数陷阱
电流采回来之后，先做Clark变换把三相电流映射到αβ轴。这里有一个常见误选：等幅值变换还是等功率变换。电流环里用等幅值变换，因为PI调节器的输出电压限幅和SVPWM的电压矢量计算都是基于幅值进行的，等幅值变换能让PI输出直接对应相电压幅值。
Park变换需要转子电角度。角度来源可以是霍尔、编码器或者无感观测器，电流环本身不关心来源，只认角度输入。在4kHz中断里计算sin/cos不能在M0上实时调库函数，常见做法是把0到360度分成1024或2048份做查表，角度分辨率约0.18度，对电流环完全够用。
定点数的坑在乘法溢出。Q15格式下两个Q15数相乘得到Q30，必须右移15位再取整。如果直接用int32接收而不移位，PI输出会大得离谱。这个坑在代码 review 时几乎每次都能看到。
3.4 第四步：两个PI调节器怎么离散化
电流环PI采用位置式离散化：输出 = Kp × 误差 + Ki × 误差累积值。d轴和q轴各一个PI，d轴给定通常为0，q轴给定来自速度环输出或力矩指令。PI输出是电压指令，经过反Park变换后送给SVPWM。
两个PI参数需要分开整定。一般的整定流程是先给一个较小的Kp，让电流环不振荡，然后逐步加大Kp直到电流响应变快但出现轻微超调，最后加Ki消除稳态误差。现场示波器观察的是q轴电流阶跃响应，超调控制在5%以内，上升时间在1ms量级，这组参数就够用。
积分限幅必须和输出限幅联动。如果输出电压已经顶到SVPWM极限，积分器还在继续累积，退出饱和时就会有一大截“回摆”，表现为电流超调和振荡。这是电流环失稳最常见的原因之一，比Kp、Ki没调好更隐蔽。
3.5 第五步：SVPWM的软件实现与比较值映射
SVPWM的经典实现分四步：判断扇区、计算相邻矢量作用时间、计算占空比、写比较寄存器。F030的主频不高，扇区判断和T1、T2计算全用定点数实现，电压矢量幅值归一化到0到1之间。
中心对齐模式下，写入比较寄存器的值等于占空比的一半。也就是说，如果SVPWM算出来某一相占空比是60%，比较值就是0.6 × (ARR + 1) × 0.5。这个换算关系经常被新手忽略，导致输出电压整体偏大或偏小。
在4kHz的周期里，SVPWM计算本身只占几百个指令周期，真正的开销在之前的坐标变换和PI上。整个中断服务函数如果控制得好，从ADC触发到PWM比较值更新，闭环延迟可以压在1.5个采样周期以内，这是保证电流环带宽的前提。
4. 可复现的程序骨架：初始化代码和4kHz电流环中断服务函数
4.1 定时器与ADC初始化：CubeMX生成后手动修改的关键点
下面这段初始化代码是CubeMX生成后我手动修改精简的。CubeMX能帮我们把时钟和引脚配好，但TIM1的触发配置、ADC采样时间和触发源一般需要自己调。
// 时钟已在 SystemClock_Config() 中配为 48MHz // TIM1: 8kHz 中心对齐1模式, PWM1 互补输出, 死区 0.5us (DT=24) TIM_TimeBaseInitTypeDef tb = {0}; tb.Period = 2999; // 48MHz / (2*3000) = 8kHz tb.Prescaler = 0; tb.CounterMode = TIM_CounterMode_CenterAligned1; tb.ClockDivision = TIM_CKD_DIV1; HAL_TIM_Base_Init(&htim1); // ADC1: 采样时间 13.5 个ADC时钟周期, 触发源选 TIM1_TRGO ADC_ChannelConfTypeDef ch = {0}; ch.Channel = ADC_CHANNEL_0; // 相电流 Ia 采样引脚 ch.SamplingTime = ADC_SAMPLETIME_13CYCLES_5; HAL_ADC_ConfigChannel(&hadc1, &ch); // TIM1 更新事件作为 ADC 触发源 TIM_MasterConfigTypeDef mstr = {0}; mstr.MasterOutputTrigger = TIM_TRGO_UPDATE; HAL_TIMEx_MasterConfigSynchronization(&htim1, &mstr);参数说明：Period = 2999对应中心对齐模式下PWM频率8kHz，这是通过48MHz除以2再除以3000得到的。采样时间13.5个周期配合ADC时钟14MHz，单次转换约0.96微秒，两相电流顺序采样总耗时约2微秒，只占4kHz中断周期的0.8%，不会拖累控制节拍。
需要特别注意的是ADC触发的时机。此时TIM1的更新事件发生在计数到0的时刻，也就是PWM周期的中点。F030的ADC转换完成后会置位标志位，中断服务函数里读取结果即可，不依赖CPU主动发起采样，抖动小。
4.2 4kHz电流环中断服务函数：从ADC读值到SVPWM更新
电流环中断每两个PWM周期进入一次，也就是4kHz。中断里做的事情按顺序固定：读ADC值、减零点偏移、Clark变换、Park变换、两个PI、反Park、SVPWM更新比较寄存器。
// 每两个PWM周期(250us)进入一次, 4kHz void TIM1_BRK_TIM1_UP_TIM1_TRG_COM_IRQHandler(void) { uint32_t ia_adc, ib_adc; int32_t i_alpha, i_beta; int32_t i_d, i_q, v_d, v_q; int32_t v_alpha, v_beta; // 1) 读取两相电流ADC结果 ia_adc = HAL_ADC_GetValue(&hadc1); // 第一次触发: A相 ib_adc = HAL_ADC_GetValue(&hadc1); // 第二次触发: B相 // 2) 零点偏移校准, 上电时测得, 这里直接减掉 ia = (int32_t)ia_adc - ia_zero; ib = (int32_t)ib_adc - ib_zero; // 3) Clark变换: 等幅值形式, 系数已合并到归一化里 i_alpha = ia; i_beta = (ia + 2 * ib) / 3; // 4) Park变换: 查表得到sin和cos, Q15格式, 右移15位 i_d = (i_alpha * cos_theta + i_beta * sin_theta) >> 15; i_q = (-i_alpha * sin_theta + i_beta * cos_theta) >> 15; // 5) 两个PI调节器, 输出限幅到0.9倍母线电压 v_d = pi_run(&pid_d, i_d_ref, i_d, &pi_d_state); v_q = pi_run(&pid_q, i_q_ref, i_q, &pi_q_state); // 6) 反Park变换得到αβ轴电压 v_alpha = (v_d * cos_theta - v_q * sin_theta) >> 15; v_beta = (v_d * sin_theta + v_q * cos_theta) >> 15; // 7) SVPWM: 计算扇区、相邻矢量时间, 更新TIM1比较值 svpwm_update(v_alpha, v_beta, &htim1); }逻辑说明：步骤3的Clark变换里，i_beta = (ia + 2 * ib) / 3是等幅值变换在假设三相电流平衡、省略C相采样时的简化写法。步骤4和步骤6里的>> 15是Q15乘法后还原精度的关键，少了这个移位，整个反馈回路会直接发散。步骤5的PI输出是电压指令，限幅到0.9倍母线电压，给SVPWM留出线性调制区间，避免过调制进入非线性区。
PI调节器内部的具体实现，我这里用了一个结构体来保存积分累积值和上次误差。抗积分饱和的逻辑在pi_run内部做：当输出达到限幅值时，积分项停止累加，但比例项仍然跟随误差变化。这样在负载突变时，PI能快速响应，同时不会因为积分饱和造成超调。
角度来源这里没有写死。如果你用的是带编码器的方案，电角度由编码器计数换算；如果是无感方案，初始角度由启动时的定位算法给出，运行中的角度由观测器提供。电流环不关心角度从哪来，但角度质量直接决定Park变换后的dq轴电流是否干净，这是后续调试无感FOC时最容易头疼的地方。
5. 4kHz电流环的避坑清单：启动、采样噪声和带宽翻车现场
5.1 现象：一使能就过流报警，或者启动瞬间电流尖峰特别大
原因：PI积分器在上电后处于未定义状态，可能带着一个很大的初始累积值。另外，电流采样零点偏移没有校准，使能瞬间采样出来的电流就是一个很大的“假电流”，PI会拼命去纠正它，结果就是过流。还有一种情况是q轴电流给定一步给到目标值，没有斜坡。
解决：每次上电后先执行零点校准，把下桥全部打开、上桥关闭，此时采样得到的ADC值就是零点偏移。使能前把两个PI的状态结构体全部清零。q轴给定加斜坡或一阶低通滤波，几百毫秒内从0升到目标值。这三步做完，大部分启动过流问题能消掉。
5.2 现象：电流波形上叠加等间距毛刺，毛刺频率和PWM频率一致
原因：采样点落在了开关噪声窗口内。中心对齐模式下，如果ADC触发配置的是上溢和下溢同时触发，而你又恰好在比较值跳变边沿附近采样，开关管的dv/dt就会通过寄生电容耦合进采样电路。F030的ADC输入没有硬件滤波，全靠软件躲噪声。
解决：把ADC触发源改成只在TIM1下溢（计数到0）时触发，不要上溢下溢都触发。检查采样时刻是否落在死区边沿附近，如果是，调整采样延迟寄存器，让采样点避开死区切换瞬间。在采样电阻到ADC引脚之间加一个RC低通，截止频率放在几百kHz，对4kHz带宽的电流环没有影响，但能显著压掉边沿毛刺。
5.3 现象：4kHz能跑，但电机啸叫明显，人站在旁边都难受
原因：PWM载波8kHz正好落在人耳最敏感的频段附近，采样谐波和电流环的高频分量叠加后产生可听噪声。这不是电流环不稳定，而是载波频率选择问题。另一个原因是SVPWM的调制方式在低调制比时产生的电流纹波偏大，噪声更大。
解决：把PWM提高到16kHz，电流环仍然保持4kHz，每4个PWM周期执行一次电流环计算。F030跑16kHz PWM多了一些中断负担，但电流环计算次数没变，整体负载可控。代价是开关损耗翻倍，低压小功率场景可以接受。做完之后啸叫会明显下降。
5.4 现象：无感FOC启动时转子先抖动一下，甚至反转
原因：转子初始位置检测失败。启动阶段电流环还没进入稳定闭环，位置角就给错了，Park变换把电流映射到错误的轴上，产生一个错误的力矩方向。F030算力有限，高频注入法跑起来很吃力，很多方案就是用开环强拉的方式启动。
解决：如果你的无感方案在F030上启动困难，先用开环强制定位：给定一个固定角度，让电流环按这个角度输出一个固定方向的电流，把转子拉到一个已知位置，持续几百毫秒。确认这个过程中电流环的id、iq能跟随给定值，再切换回无感运行。这个阶段是整个无感FOC的地基，电流环响应慢或者有振荡，后面的启动逻辑全都会翻车。
5.5 现象：空载和轻载都正常，一加负载电流环就振荡
原因：负载变大后，q轴电流给定增大，PI输出电压频繁顶到限幅值。如果积分项在这个状态下继续累积，退出饱和时会产生积分回摆，电流波形出现低频振荡，甚至伴随母线电压剧烈波动。
解决：做抗积分饱和的三种常见处理，按优先级推荐：最省事的是积分限幅跟随输出限幅，输出饱和时积分项冻结；更温和的做法是积分分离，误差大于某个阈值就只跑比例项；负载变化频繁的场景可以上动态变PI增益。验证方法是用信号源给q轴电流加一个20%的突加阶跃，示波器抓q轴电流，看是否出现超调后多次振荡。出现两次以上振荡，基本就是积分环节没处理好。
6. 验证与进阶：怎么确认你的4kHz电流环真的合格
6.1 用方波给定测电流环带宽
电流环调完参数，别急着上速度环。我的习惯是先在q轴电流给定上加一个额定电流5%左右的方波，频率1到2Hz，示波器抓q轴电流响应。测上升时间tr，经验上闭环带宽约等于0.35除以tr。4kHz采样率下，如果tr在1毫秒左右，带宽约350Hz，这个结果在当前配置下就算健康。如果tr小于0.5毫秒，表面看很快，但实际上相位裕度已经很低，一加载就会振。
6.2 从4kHz往上挤：到8kHz的代价
如果想在F030上把电流环从4kHz提到8kHz，中断周期从250us缩到125us，可用指令数减半。这时SVPWM必须改成更省指令的查表版本，PI不能再做任何除法操作，ADC采样时间也要重新匹配。实测下来能跑，但余量很小，建议先花时间优化中断耗时再动频率，不然算力全烧在控制计算上，留给速度环和通信的时间就没有了。
6.3 下一步：速度环和无感FOC怎么往上搭
4kHz电流环稳住后，速度环放在1kHz就够了，让出大部分CPU给通信、保护和状态机。无感FOC方向的下一步是转子初始位置检测，高频注入在F030上算力紧张，很多项目最后用了开环强拉加反电动势观测器的组合路径。
我的个人习惯是：电流环参数从来不在电机上拍脑袋调。先用电阻负载或者台架把采样链路标定干净，再测带宽，最后才上电机带载。这套方法帮我少翻了很多次车。4kHz电流环在F030上不是一个极限项目，它是个基本功项目——把采样踩准、把中断写短、把积分管住，这份程序就能成为你后面所有电机控制工作的根据地。希望帮到你。
本文还有配套的精品资源，点击获取
