FOC电流环实现笔记：Clark/Park推导、SVPWM与C代码落地

简介这份笔记面向正在学习或实现FOC电机控制的读者围绕磁场定向控制的核心链路整理数学推导与工程实现思路适合具备一定电机学、C语言和Simulink基础、希望把公式落到代码中的初中级开发者。内容从FOC本质与超前角控制切入依次梳理Clark、Park及逆变换的公式推导与程序实现并展开SVPWM的扇区判断、非零与零矢量作用时间、过调制处理和切换点确定还涉及PID离散化、位置式与增量式差异、参数整定及积分抗饱和最后说明磁链圆限制中MAX_MODULE与START_INDEX的确定和实现。包内为1个PDF压缩包约7.34MB目录按知识点组织便于按模块查阅和对照代码练习。已有1920人学习可作为FOC学习中的公式速查、推导复盘、算法实现参考也能为课程设计、毕业设计和驱动器调试提供对照。1. 调 FOC 电流环最难受的时刻不是电机不转调 FOC 电流环最难受的时刻不是电机不转而是它转得挺顺、相电流看着也像正弦可给定 iq1A实际只有 0.5A角度还偏了三十度。翻寄存器手册翻了两天没找到问题最后回到草稿纸把 Clark 变换重推一遍才发现代码里系数按恒功率取的SVPWM 那边按等幅值算两边差了一个因子。这类问题手册不会写只有把数学推导从头走一遍才看得见。这份 FOC 学习笔记就是冲着这类问题整理的。它不教电机怎么绕线而是把 FOC 里绕不开的几块硬骨头——Clark、Park、逆 Park 的数学推导SVPWM 的扇区判断与作用时间PID 离散化与积分抗饱和磁链圆限制——按“先推公式、再写函数”的顺序过一遍每个结论后面都跟一段可以编译的 C 代码。适合已经能让电机转起来、但说不清每个系数怎么来的嵌入式开发者也适合刚学电机控制、想把课本公式敲成代码的学生。下面按笔记的组织顺序拆顺带补上我实际调机时踩过的坑。2. 笔记的结构六块内容怎么串成一条从电流采样到 PWM 的链2.1 六块内容不是并列是一条单向依赖链初看目录容易以为六块内容是并列的知识点实际动手写代码就会发现它们是一条链FOC 本质决定控制目标定子电流矢量超前转子 d 轴 90 度Clark 把三相电流降成 αβ 两相Park 把 αβ 转到随转子旋转的 dqPID 在 dq 上做闭环算出 ud、uq逆 Park 再把 ud、uq 转回 αβSVPWM 把 αβ 电压矢量变成三相占空比磁链圆限制卡在逆 Park 之前防止合成矢量超出线性调制区。任何一环的坐标系约定不一致波形就会以“看着对、实际不对”的方式翻车。笔记的目录大致是这么组织的模块输入输出关键公式或参数FOC 本质转子电角度控制目标电流矢量超前 d 轴 90°Clarkia、ib、iciα、iβ等幅值系数 2/3Parkiα、iβ、θid、iq正余弦表PIDid_ref、iq_refud、uqKp、Ki、抗饱和磁链圆限制ud、uqud、uqMAX_MODULE、START_INDEX逆 Parkud、uq、θuα、uβ正交矩阵转置SVPWMuα、uβ、Udc三相比较值扇区 N、T1、T2把这张表贴在显示器边上调机时对着看比翻笔记正文快。我一般会在每个函数的入口打印一次输入输出跑一遍开环就能确认哪一段的幅值或角度对不上。2.2 定点还是浮点代码里的取舍笔记里的 Park 函数没有直接调 sinf/cosf而是走了一张正余弦表返回 Q15 格式的整数再乘 1/32768 转成浮点。这样做的好处很直接 Cortex-M0/M3 这类没有 FPU 的芯片一次 sinf 动辄几百个周期电流环 20kHz 根本扛不住查表加一次乘法几十个周期就够。代价是角度分辨率表长 1024 点时最小角约 0.35 度低速轻载时能看出一点转矩脉动但对风扇、云台这类负载完全够用。typedef struct { int16_t hCos; int16_t hSin; } Trig_Components; #define DIV_Q15 (1.0f / 32768.0f) /* hAngle: 0~65535 对应 0~2π返回 Q15 格式的 sin/cos */ Trig_Components Trig_Functions(int16_t hAngle);这里有两个容易忽略的点。一是角度标幺化的位宽要和定时器一致如果电角度用 0~65535 表示一圈那么 65536/1024 就是查表步长取整时的截断误差会累积成固定角度偏差二是 hSin、hCos 返回的是有符号 Q15乘以 DIV_Q15 之后范围是 -1 到 1别再把符号位当无符号处理。实际工程里我会把表长做成宏方便在 Flash 紧张的芯片上换成 256 点。2.3 没有硬件怎么验证Simulink 对拍加手算单点笔记里给了 Simulink 仿真的思路但没有展开。我的做法是三层对拍第一层手算固定 θ30°、ia1、ib-0.5、ic-0.5手算出 iα1、iβ0.866、id1、iq0把结果写死在单元测试里第二层 MATLAB 对拍把 C 函数用 MATLAB Function 块包起来和 Simulink 里搭的三相逆变器加电机模型跑同一组输入看两条曲线的误差是否在 1e-4 以内第三层上板用 DAC 或者 PWM 加 RC 滤波把 iα、iβ、马鞍波引出来示波器上看形状。% 单点对拍固定角度和三相电流验证 Clark/Park 链路 theta pi/6; ia 1.0; ib -0.5; ic -0.5; i_alpha ia; i_beta (ia 2*ib)/sqrt(3); id i_alpha*cos(theta) i_beta*sin(theta); iq -i_alpha*sin(theta) i_beta*cos(theta); fprintf(i_alpha%.6f i_beta%.6f id%.6f iq%.6f\n, ... i_alpha, i_beta, id, iq);这段脚本的价值不在算得多准而在于它把“角度单位是弧度还是标幺值”这类低级错误挡在烧板之前。我见过有人把电角度直接按弧度传给查表函数结果电机堵转发热查了一下午才定位到单位。3. Clark 与 Park两个坐标变换的推导、系数和 C 函数3.1 Clark 变换从基尔霍夫电流定律到两行代码推导的起点很朴素三相星形接法没有中线任一时刻 iaibic0三个未知数其实只有两个独立所以可以降到两维。把三相轴放在平面上a 轴指向 0°b 轴 120°c 轴 240°把三个电流投影到正交的 α、β 轴上得到 iα k(ia - ib/2 - ic/2)iβ k(√3/2)(ib - ic)。再把 ic -ia - ib 代进去就得到笔记里那两行typedef struct { float ia, ib, ic; } abc_t; typedef struct { float i_alpha, i_beta; } alphaBeta_t; alphaBeta_t Clark(abc_t input) { alphaBeta_t output; /* 已代入 ic -ia - ib等幅值系数 k 2/3 被消掉 */ output.i_alpha input.ia; /* 1/√3 ≈ 0.577350269 */ output.i_beta (input.ia 2.0f * input.ib) * 0.577350269f; return output; }代码里看不到 2/3是因为 ic 已经被消掉系数在化简过程中自然约掉了。这也是很多人第一次看这段代码觉得“少了点什么”的原因。参数上输入是三相瞬时电流单位安培输出 iα、iβ 也是安培0.577350269 是 1/√3 的浮点近似如果你用 double 可以写得更长但在单精度下这个精度足够。采样电路只需要采 a、b 两相c 相由 KCL 算出来省一路运放和 ADC这是笔记里明确提到的成本收益。3.2 等幅值还是恒功率2/3 和 √(2/3) 怎么选系数 k 有两种取法等幅值取 2/3恒功率取 √(2/3)。前者的物理意义是变换前后矢量幅值不变三相电流峰值 1A变换后 iα、iβ 合成的矢量幅值还是 1A后者保证变换前后功率相等但矢量幅值会变成原来的 √(3/2) 倍。笔记里写得很清楚FOC 里一般用等幅值因为 SVPWM 的线性调制区是按相电压峰值 Udc/√3 划的如果 Clark 用了恒功率系数逆变换出来的电压矢量会大出 1.5 倍直接冲出磁链圆表现为过调制、波形削顶。变换类型系数 kiα 表达式合成矢量幅值适用场景等幅值2/3ia等于相电流峰值FOC SVPWM恒功率√(2/3)(2/3)(ia - ib/2 - ic/2) 的 √(3/2) 倍相电流峰值的 √(3/2) 倍功率分析、Simulink 功率测量实际项目里我会在头文件里放一个#define CLARK_KClark 和逆 Clark 共用同一个宏避免一边改一边忘。这个习惯来自一次真实的翻车调试时把 Clark 改成恒功率想看功率波形忘了改逆变换电机直接啸叫。3.3 Park 与逆 Park正余弦表的精度决定电流环噪声Park 变换的几何意义是把静止的 αβ 坐标系转到随转子一起转的 dq 坐标系转轴角度就是电角度 θ。投影公式是 id iαcosθ iβsinθiq -iαsinθ iβcosθ。写成代码就是四个乘法和两个加法成本很低真正的成本在 θ 的获取和正余弦的精度上。typedef struct { float id, iq; } dq_t; dq_t Park(alphaBeta_t input, int16_t theta) { dq_t output; Trig_Components sc Trig_Functions(theta); float cos_da sc.hCos * DIV_Q15; /* Q15 转浮点范围 -1~1 */ float sin_da sc.hSin * DIV_Q15; output.id input.i_alpha * cos_da input.i_beta * sin_da; output.iq -input.i_alpha * sin_da input.i_beta * cos_da; return output; } alphaBeta_t Rev_Park(dq_t input, int16_t theta) { alphaBeta_t output; Trig_Components sc Trig_Functions(theta); float cos_da sc.hCos * DIV_Q15; float sin_da sc.hSin * DIV_Q15; /* 正交矩阵的逆等于转置符号与正变换相反 */ output.i_alpha input.id * cos_da - input.iq * sin_da; output.i_beta input.id * sin_da input.iq * cos_da; return output; }参数 theta 用的是 0~65535 的标幺电角度不是弧度这一点在函数签名里就该注释清楚。逆变换的矩阵是正交矩阵逆等于转置所以只需要把 sin 项的符号翻过来不需要真的求逆这也是笔记里强调“电角度定义可以随便但 dq 轴定义不变”的原因无论 θ 取 d 轴与 α 轴夹角还是与 a 轴夹角只要正变换和逆变换用的是同一个 θ闭环就能成立。3.4 把三个变换串成一个电流采样中断单独看每个函数都简单串起来才是工程。一个典型的电流环中断里执行顺序是ADC 采样 ia、ibClark 得到 iα、iβPark 得到 id、iq和给定值比较后送 PIDPID 输出 ud、uq经磁链圆限制逆 Park 回 αβ最后送 SVPWM。整条链路里 θ 必须用同一个时刻的值如果 Park 用的是上一个周期的角度、逆 Park 用的是当前角度高速时会出现明显的角度滞后表现为 iq 跟不上给定、效率下降。我一般会在中断入口先把编码器或观测器的角度锁存到一个局部变量后面所有变换都用这个副本中断末尾再更新。这个细节笔记里没有展开但它是电流环能不能跑满带宽的前提。4. SVPWM 与电流环扇区判断、七段式序列和磁链圆限制4.1 六个基本矢量与伏秒平衡三相逆变器有六个开关管上下桥臂互补有效开关状态有八个六个非零矢量加两个零矢量。笔记里的编号按三相开关字 S1S2S3 的二进制值来100 记作 U4、110 记作 U6、010 记作 U2、011 记作 U3、001 记作 U1、101 记作 U5幅值都是 2Udc/3相邻矢量间隔 60°。任意一个参考电压矢量 Uref 落在某个 60° 扇区里都可以用相邻两个非零矢量加零矢量按伏秒平衡合成Uref·Ts Ux·Tx Uy·Ty U0·T0。这里 Udc 是母线电压Ts 是 PWM 周期。笔记里特意推了一遍 2Udc/3 的来历三相桥臂中点相对电源负极的电压只有 0 和 Udc 两种但电机绕组中性点浮空相电压要减去中性点电位最后合成矢量的幅值就是 2Udc/3。这个推导不难但跳过去的话后面算作用时间时很容易把 Udc 和 2Udc/3 搞混。4.2 扇区判断N A 2B 4C扇区判断不用 atan2用三个符号判断就够。定义 Uref1 UβUref2 (√3/2)Uα - (1/2)UβUref3 -(√3/2)Uα - (1/2)Uβ分别判断这三个量是否大于零得到 A、B、C 三个布尔值再令 N A 2B 4C。N 和扇区的对应关系是固定的3 对应 I1 对应 II5 对应 III4 对应 IV本文还有配套的精品资源点击获取