1. 从“升魂浩荡”说起这套FOC电流环到底在折腾什么“升魂浩荡”这个词放在电机控制里其实挺传神——调电流环调到半夜看着示波器上那根毛刺乱飞的波形确实有种灵魂出窍的感觉。我做了七八年电机驱动从方波六步换相一路做到无感FOC踩过的坑能填满一个篮球场。今天聊的这套东西核心就是FOC磁场定向控制里的电流环程序实现说白了就是让电机的定子电流乖乖听话指哪打哪。先给不太熟的朋友交个底。FOC的本质是把三相交流电机的定子电流通过Clarke变换和Park变换从静止的三相坐标系ia、ib、ic转到跟着转子旋转的两相坐标系id、iq。转过去之后id控制励磁分量iq控制转矩分量两个量在稳态下都是直流量。直流量好控制啊一个PI调节器就能做到零稳态误差。这就是为什么FOC比传统的V/F控制、六步换相要“高级”——它把交流问题变成了直流问题。电流环是整个FOC三环结构电流环、速度环、位置环里最内层的一环也是带宽最高、响应最快的一环。电流环跑不好外面速度环和位置环全是空中楼阁。我见过太多人速度环参数调得飞起结果电流环一塌糊涂电机一转起来就啸叫、发热、甚至炸管。所以这篇文章的重点就一个把电流环程序从原理到代码到调试掰开揉碎讲清楚。适合谁看如果你正在用STM32、TI C2000或者国产MCU做PMSM/BLDC的FOC驱动电流环采样有噪声、PI参数整定靠试凑、解耦补偿搞不明白那这篇东西应该能帮你省下不少烧管子和掉头发的钱。如果你连Clarke/Park变换是什么都还没搞懂建议先补一下基础但也不妨碍你往下看我会尽量用大白话解释。2. 电流环的整体设计思路与方案选型2.1 为什么电流环必须跑在最高优先级中断里电流环的实时性要求极高。以常见的10kHz开关频率为例每个PWM周期只有100微秒。在这100微秒里你要完成ADC采样三相电流、Clarke变换、Park变换、两个PI调节器计算、反Park变换、SVPWM占空比计算、更新PWM寄存器。这一套下来在168MHz的STM32F4上大概要跑3到5微秒看起来余量很大但如果你把电流环放在主循环里轮询那就完蛋了。我早期做过一个项目为了图省事把电流环放在1kHz的定时器中断里开关频率设了10kHz。结果电机一转起来电流波形像锯齿一样iq给定和反馈之间差了将近30度相位。原因很简单电流环的采样和控制频率必须和PWM频率同步否则采样时刻和PWM更新时刻对不上等效于引入了一个巨大的延迟。后来改成PWM下溢中断触发ADCADC转换完成中断里跑电流环波形立刻就干净了。所以第一条铁律电流环必须由PWM定时器的下溢事件触发ADC采样时刻要和PWM中心对齐。具体来说如果你用的是中心对齐模式在计数器等于零的时候触发ADC采样这时候三相下桥臂全部导通采样电阻上的电流就是真实的相电流。这个时刻选不对采到的就是开关噪声后面PI调得再好也是白搭。2.2 电流采样方案单电阻、双电阻还是三电阻这是硬件设计阶段就要定下来的事但软件工程师必须懂否则程序没法写。三电阻采样是最省心的方案每相下桥臂各串一个采样电阻三个ADC通道同时采样。优点是任何时刻都能采到三相电流Clarke变换直接算就行。缺点是成本高、PCB面积大而且三个电阻的温漂要一致否则引入直流偏置。双电阻采样省了一个电阻但代价是必须保证至少有两相下桥臂导通才能采样。在SVPWM的某些扇区里某一相占空比接近100%下桥臂导通时间极短ADC根本来不及采。所以双电阻方案通常要限制最大占空比或者用“移相采样”的技巧。我一般建议新手从三电阻入手等玩熟了再考虑降成本。单电阻采样最便宜但最麻烦。它只在特定的PWM开关组合下才能采到电流而且需要根据扇区重构三相电流。程序复杂度直线上升采样窗口可能只有几百纳秒对ADC采样保持时间要求极高。除非是量产项目成本卡得很死否则我不推荐。采样方案优点缺点适用场景三电阻任意时刻可采程序简单成本高占PCB面积工业伺服、高精度场合双电阻成本适中程序较简单需限制占空比低调制区有盲区家电、风机、水泵单电阻成本最低程序复杂采样窗口窄低成本量产、对体积敏感2.3 电流环PI调节器的结构选择电流环的PI调节器有两种常见结构串联式和并联式。串联式就是误差先过PI输出再乘一个增益并联式是比例和积分并行。在数字实现里我更倾向于用增量式PI因为增量式不需要累加历史误差抗积分饱和处理起来更自然。但这里有个坑很多人直接把连续域的PI公式搬到代码里结果发现积分项在每次中断里累加积分增益Ki设大了就振荡设小了响应慢。问题出在积分时间常数的离散化上。连续域PI是u(t) Kp * e(t) Ki * ∫e(t)dt离散化之后积分项应该写成I(k) I(k-1) Ki * Ts * e(k)其中Ts是电流环周期。很多人忘了乘Ts导致Ki的实际效果和理论差了一个数量级。我一般会在代码里把Ki定义成“积分增益”然后实际累加的是Ki * Ts * e(k)这样调参的时候心里有数。另外抗积分饱和是必须做的。电机启动瞬间iq给定可能从0直接跳到额定值误差很大积分项会迅速累加到饱和。如果不处理等反馈跟上来了积分项还在最大值下不来电流就会过冲甚至振荡。我常用的做法是当PI输出超过限幅值时停止积分累加或者把积分项钳位在限幅值附近。3. 核心细节解析与实操要点3.1 Clarke变换和Park变换的代码实现细节Clarke变换把三相电流变成两相静止坐标系下的iα和iβ。对于三相平衡系统iaibic0等幅值Clarke变换是iα ia iβ (ia 2*ib) / √3注意这里用的是等幅值变换不是等功率变换。等幅值变换的好处是电压和电流的幅值在变换前后一致PI调节器的输出直接对应相电压幅值物理意义清晰。等功率变换会多一个√(2/3)的系数在需要计算功率的时候才用。Park变换把iα、iβ转到旋转坐标系id iα * cosθ iβ * sinθ iq -iα * sinθ iβ * cosθθ是转子电角度来自编码器或者无感观测器。这里有个细节θ的精度直接影响iq的控制效果。如果θ有偏差id和iq之间会串扰本来只想给iq结果id也冒出来了。我实测过θ偏差10度iq的幅值会下降约1.5%同时id出现一个和iq同量级的直流分量。对于需要精确转矩控制的场合这个误差不能忍。所以如果你用的是增量式编码器一定要做电角度对齐。具体做法是给d轴通一个固定电压让转子转到d轴对齐的位置然后把编码器读数清零或者记录偏移量。这个过程在量产时每个电机都要做一次因为编码器安装位置有机械公差。3.2 电流环PI参数整定的工程方法PI参数整定是电流环最核心也最让人头疼的部分。理论上有零极点对消法把电机电气模型看成RL串联电路传递函数是1/(LsR)PI调节器的零点设在R/L处对消掉电机的极点然后根据想要的带宽算Kp。公式是Kp L * ωc Ki R * ωc其中ωc是电流环带宽一般取开关频率的1/10到1/5。比如10kHz开关频率带宽取1kHz到2kHz。但理论归理论实际调的时候你会发现电机参数L和R随温度、电流饱和变化很大。我一般先用理论值算一个初值然后在实验中微调。调试步骤是这样的先把Ki设为0只调Kp。给iq一个阶跃给定比如从0跳到额定电流的10%看反馈波形。Kp太小响应慢Kp太大超调振荡。调到临界振荡再往回退30%左右。然后加Ki。Ki的作用是消除稳态误差。慢慢增大Ki直到阶跃响应的稳态误差在合理时间内归零同时不引起低频振荡。最后看id的响应。如果id在iq阶跃时也有明显波动说明解耦没做好或者θ有偏差。我踩过的一个坑PI输出没有做限幅。有一次调一个低压小电机Kp给大了PI输出直接冲到PWM占空比的100%结果上下桥臂直通炸了两个MOS管。后来学乖了PI输出一定要钳位在SVPWM能接受的最大电压矢量幅值以内一般是母线电压的1/√3。3.3 电流环解耦补偿什么时候需要什么时候可以偷懒在旋转坐标系下d轴和q轴之间存在交叉耦合项ud Rid Ldd(id)/dt - ωeLqiq uq Riq Lqd(iq)/dt ωeLdid ωe*ψf其中ωe是电角速度ψf是永磁体磁链。那个-ωeLqiq和ωeLdid就是耦合项。在低速时ωe很小耦合项可以忽略PI调节器自己就能把误差压下去。但在高速时耦合项可能占到总电压的30%以上PI调节器为了补偿这个耦合会输出一个额外的电压导致id和iq互相干扰。前馈解耦的做法是在PI输出上直接加上耦合项的补偿值。这样PI只需要处理模型误差和扰动负担大大减轻。我实测过在3000rpm以上加了解耦之后iq的跟踪误差从15%降到3%以内。但解耦需要知道Ld、Lq和ψf。对于表贴式PMSMLd≈Lq解耦简单一些。对于内置式PMSMLd和Lq差很多而且随电流饱和变化解耦参数不准反而会引入新的扰动。所以我的建议是低速应用可以不做解耦高速应用必须做但参数要在线辨识或者查表。4. 实操过程与核心环节实现4.1 硬件平台搭建与ADC校准我最近做的一个项目用的是STM32G474内置了高分辨率定时器和运放很适合做FOC。硬件配置如下PWM频率20kHz中心对齐模式ADC采样三相下桥臂电阻采样运放增益10倍偏置1.65V编码器2500线增量式四倍频后10000脉冲/转母线电压24V电机额定电流5A第一步是ADC偏置校准。上电时电机没转三相电流应该为零但ADC读数不一定是零因为运放有失调电压。我一般会在初始化时连续采样100次取平均值作为零偏后续所有采样值都减去这个零偏。这个步骤不做id和iq上会有直流偏置导致电机发热。#define ADC_OFFSET_SAMPLES 100 void ADC_Offset_Calibration(void) { int32_t sum_a 0, sum_b 0, sum_c 0; for (int i 0; i ADC_OFFSET_SAMPLES; i) { sum_a ADC_GetValue(ADC_CH_A); sum_b ADC_GetValue(ADC_CH_B); sum_c ADC_GetValue(ADC_CH_C); Delay_us(10); } offset_a sum_a / ADC_OFFSET_SAMPLES; offset_b sum_b / ADC_OFFSET_SAMPLES; offset_c sum_c / ADC_OFFSET_SAMPLES; }第二步是电流标定。ADC读数要转换成安培需要知道采样电阻阻值、运放增益和ADC参考电压。比如采样电阻0.01Ω运放增益10倍ADC 12位、参考电压3.3V那么电流(A) (ADC值 - 零偏) * 3.3 / 4096 / 10 / 0.01算下来每个ADC码对应约0.008A。这个系数要写死在代码里或者通过上位机标定。4.2 电流环中断服务程序的完整实现下面是我在实际项目中用的电流环中断服务程序框架基于STM32 HAL库但逻辑是通用的void PWM_Underflow_ISR(void) { // 1. 读取三相电流 ia (ADC_GetValue(ADC_CH_A) - offset_a) * CURRENT_SCALE; ib (ADC_GetValue(ADC_CH_B) - offset_b) * CURRENT_SCALE; ic (ADC_GetValue(ADC_CH_C) - offset_c) * CURRENT_SCALE; // 2. Clarke变换 i_alpha ia; i_beta (ia 2.0f * ib) * ONE_BY_SQRT3; // 3. 获取电角度 theta_e Encoder_GetElecAngle(); sin_theta arm_sin_f32(theta_e); cos_theta arm_cos_f32(theta_e); // 4. Park变换 id i_alpha * cos_theta i_beta * sin_theta; iq -i_alpha * sin_theta i_beta * cos_theta; // 5. 电流环PI调节 id_error id_ref - id; iq_error iq_ref - iq; ud_pi PI_Calc(pi_d, id_error); uq_pi PI_Calc(pi_q, iq_error); // 6. 前馈解耦 ud ud_pi - omega_e * Lq * iq; uq uq_pi omega_e * (Ld * id psi_f); // 7. 电压限幅 ud CLAMP(ud, -U_MAX, U_MAX); uq CLAMP(uq, -U_MAX, U_MAX); // 8. 反Park变换 u_alpha ud * cos_theta - uq * sin_theta; u_beta ud * sin_theta uq * cos_theta; // 9. SVPWM计算 SVPWM_Calc(u_alpha, u_beta, duty_a, duty_b, duty_c); // 10. 更新PWM寄存器 PWM_SetDuty(duty_a, duty_b, duty_c); }这个框架里第5步的PI_Calc函数需要处理抗积分饱和。我的做法是float PI_Calc(PI_Handle *pi, float error) { float p_term pi-Kp * error; float i_term pi-integral; float output p_term i_term; // 抗积分饱和输出限幅时停止积分 if (output pi-out_max) { output pi-out_max; if (error 0) pi-integral pi-Ki * pi-Ts * error; } else if (output pi-out_min) { output pi-out_min; if (error 0) pi-integral pi-Ki * pi-Ts * error; } else { pi-integral pi-Ki * pi-Ts * error; } return output; }注意这里的积分项只在输出未饱和或者误差方向有助于退出饱和时才累加这就是所谓的“条件积分”抗饱和。4.3 SVPWM的实现与死区补偿SVPWM空间矢量脉宽调制是FOC的标准调制方式比SPWM的直流电压利用率高15.5%。它的核心是根据uα和uβ判断扇区然后计算相邻两个基本矢量的作用时间。我一般用七段式SVPWM每个PWM周期内开关序列对称谐波性能好。具体实现网上代码很多我就不贴了。但有一个坑必须提死区补偿。死区是为了防止上下桥臂直通而插入的短暂全关时间一般几百纳秒。死区会导致实际输出电压和给定电压有偏差在低速时尤其明显表现为电流波形过零点畸变。补偿的方法是根据电流方向在占空比上加减一个死区补偿量。我实测过不加死区补偿低速时电流THD能到8%以上加了之后降到3%左右。// 死区补偿示例 if (ia 0) duty_a deadtime_comp; else duty_a - deadtime_comp; // 同理处理b相和c相4.4 上位机调试与波形观测调电流环离不开上位机。我一般用串口或者CAN把id、iq、id_ref、iq_ref、ud、uq这些变量传到上位机用VOFA或者自己写的Qt界面画波形。采样率不用太高1kHz就够了因为电流环的响应时间在毫秒级。这里有个技巧用DAC输出关键变量。STM32的DAC可以实时输出id和iq的模拟量直接接示波器看比串口传数据快得多而且没有传输延迟。我一般把DAC通道1设为id通道2设为iq触发模式设为PWM下溢这样示波器上看到的波形和实际电流环同步非常直观。5. 常见问题与排查技巧实录5.1 电流采样噪声大、波形毛刺多这是最常见的问题。原因可能有几个采样时刻不对如果ADC采样时刻在开关管切换的瞬间采到的全是开关噪声。解决办法是把ADC触发时刻设在PWM中心也就是计数器为零的时候。采样电阻走线太长采样电阻的电压信号很微弱几十毫伏走线长了容易引入干扰。要用开尔文连接差分走线尽量靠近运放。运放带宽不够电流信号有高频分量运放带宽不够会导致信号失真。一般选10MHz以上的运放。ADC参考电压不稳参考电压波动会直接反映在采样值上。要用低噪声LDO给参考电压供电旁边加去耦电容。我遇到过一次特别诡异的噪声排查了半天发现是电机外壳没接地。电机外壳浮空相当于一个大天线把开关噪声耦合到了电流采样线上。把外壳接到驱动板的地之后噪声立刻消失了。5.2 电流环振荡、电机啸叫电流环振荡的典型表现是iq反馈在给定值附近高频抖动电机发出刺耳的啸叫。原因和解决办法现象可能原因排查方法解决办法高频振荡Kp太大减小Kp看是否改善降低Kp增大带宽余量低频振荡Ki太大减小Ki看是否改善降低Ki或加抗饱和周期性抖动角度偏差检查θ对齐重新做电角度对齐随转速加剧解耦参数不对关闭解耦看是否改善重新辨识Ld、Lq特定转速振荡机械共振扫频测试加陷波滤波器我印象最深的一次是调一个高速风机电流环在2000rpm以下都正常一到2500rpm就开始啸叫。后来发现是速度环和电流环带宽太接近两个环互相干扰。把电流环带宽从2kHz提到4kHz速度环降到200Hz问题解决。所以三环的带宽要拉开一般电流环带宽是速度环的5到10倍。5.3 id不为零、有直流分量id应该控制为零表贴式PMSM或者负值内置式PMSM弱磁如果id有直流分量说明电流采样零偏没校准重新做ADC偏置校准。θ有偏差id的直流分量和θ偏差成正比。做电角度对齐。三相不平衡电机绕组不对称或者采样通道增益不一致。检查硬件。我遇到过一次id直流分量特别大查了半天发现是C相采样电阻虚焊导致ic读数始终为零Clarke变换出来的iα和iβ全错了。所以硬件问题永远要先排除别一上来就怀疑算法。5.4 启动时过流保护触发电机启动瞬间iq给定从0跳到额定值如果PI响应太快电流会过冲触发过流保护。解决办法给定斜坡iq_ref不要直接跳变加一个斜率限制比如每毫秒增加0.1A。启动前预定位先给d轴通一个小电流把转子拉到已知位置再给q轴电流。PI输出限幅启动时把PI输出限幅设小一点等稳定后再放开。我一般会在启动阶段用电流斜坡从0慢慢加到目标值时间大概100到200毫秒。这样既不会过流也不会因为启动太慢影响响应。5.5 常见问题速查表问题首要排查方向快速验证方法电机不转PWM输出、使能信号示波器看PWM引脚电机抖动不连续角度θ、编码器手动转电机看θ变化电流波形畸变死区、采样时刻示波器看相电流发热严重id不为零、开关损耗测id平均值高速失控解耦、电压限幅关闭解耦对比噪声大接地、采样电阻短接采样电阻看噪声6. 一些掏心窝子的实操心得调电流环这件事说难也难说简单也简单。我做了这么多年最大的体会是硬件是基础算法是锦上添花。很多人一上来就研究各种高级算法什么滑模观测器、模型预测控制结果连最基本的电流采样都没搞干净调什么都白搭。我的建议是先把三电阻采样、中心对齐PWM、电角度对齐这三件事做扎实然后用一个最朴素的PI调节器把电流环调到阶跃响应无超调、稳态无误差。这个过程可能需要反复试但一旦调通了你对FOC的理解会上一个台阶。另外示波器是你的好朋友。不要只盯着上位机的波形看上位机的数据是经过串口传输、可能还有滤波的会丢失很多细节。用示波器直接看采样电阻上的电压、看DAC输出的id/iq、看PWM占空比很多问题一眼就能看出来。最后说一个我最近才想明白的事电流环的带宽不是越高越好。理论上带宽越高响应越快但实际受限于采样频率、计算延迟、PWM更新延迟带宽太高反而会引入相位滞后导致振荡。我一般把电流环带宽设在开关频率的1/10左右比如20kHz开关频率带宽设2kHz留足相位裕度。这个值不是绝对的要根据电机参数和硬件条件调整但作为一个起点不会出大错。电机控制这个领域理论很重要但经验更重要。书本上的公式都是理想情况实际电机有饱和、有温漂、有死区、有各种你想不到的干扰。多动手、多测量、多思考比看一百篇论文都管用。
