1. 为什么我要写这个FOC无感控制专栏搞电机控制这些年最常被问到的问题就是“FOC到底怎么入门”、“无感控制为什么我的电机转不起来”、“滑膜观测器参数怎么调”。说实话这些问题我在刚接触FOC的时候也全都踩过一遍。市面上讲FOC的资料不少但要么是纯理论推导满篇公式看完还是不知道怎么下手要么是直接甩一份代码关键参数怎么来的、为什么这么选全靠自己猜。这个专栏就是想把这两者之间的鸿沟填上——从坐标变换的物理意义到SVPWM的波形生成再到无感观测器的工程实现每一步我都尽量讲清楚“为什么这么做”和“实际怎么做”。这个专栏适合谁看如果你已经会用STM32或者类似的MCU点灯、跑定时器想进一步搞永磁同步电机的无感FOC控制那这里的内容就是为你准备的。如果你已经做过有霍尔的FOC想切到无感方案但一直被启动和低速观测卡住专栏里关于滑膜观测器和启动策略的部分应该能帮到你。甚至你如果只是对电机控制感兴趣想搞明白手里的电调或者开源固件比如VESC、Moteus里面到底在算什么也可以跟着看我会尽量把工程实现和理论对应起来讲。整个专栏的规划大致是这样的先从FOC的整体框架和坐标变换讲起把Clarke、Park变换的来龙去脉说透然后进入SVPWM的原理和定时器配置这部分会结合STM32的定时器讲具体怎么发波接着是电流环和速度环的设计包括PID参数整定和带宽的理解再往后就是重头戏——无感控制重点讲滑膜观测器的设计、转子初始位置检测和启动策略最后会聊一些工程上的坑比如PWM死区、采样时机、参数辨识这些。每一篇都会尽量给出可复现的步骤和参数计算过程代码层面以STM32为主但思路是通用的。注意这个专栏假设你已经具备基本的C语言编程能力和MCU外设使用经验比如定时器、ADC、中断这些。如果你还没接触过这些建议先补一下基础不然直接看FOC的实现会比较吃力。2. FOC无感控制的核心框架拆解2.1 为什么是FOC而不是方波控制BLDC电机的控制方式大致分两类方波控制六步换相和正弦波控制FOC。方波控制简单粗暴任何时候只有两相通电第三相悬空靠反电动势过零来判断换相点。这种方式实现容易成本低但问题也很明显——转矩脉动大噪音大低速性能差。你如果拆过便宜的电风扇或者玩具车里面大概率就是方波控制。FOCField-Oriented Control磁场定向控制的思路完全不同。它把三相电流通过坐标变换映射到随转子旋转的dq坐标系下d轴对准转子磁场方向q轴垂直于d轴。这样一来原本耦合的三相电流就变成了两个直流量d轴电流控制磁场q轴电流控制转矩。控制直流量比控制交流量容易得多PID调节器就能搞定。转矩脉动小、噪音低、效率高这些都是FOC的优势。代价是什么计算量大。Clarke变换、Park变换、两个电流环PID、反Park变换、SVPWM生成这一套下来对MCU的算力有要求。不过现在STM32F4、G4这些带FPU的芯片价格已经很亲民了跑FOC绰绰有余。我实测过在STM32G431上跑10kHz的电流环CPU占用率大概在30%左右还有足够的余量做速度环和观测器。2.2 有感和无感的本质区别有霍尔或者编码器的FOC转子位置是直接测出来的观测器这一块可以完全不用。无感FOC的核心难点就在于没有位置传感器转子的角度怎么知道答案是从电机的电气量里“算”出来。永磁同步电机的定子电压方程和磁链方程里包含了转子位置信息通过测量相电压和相电流结合电机参数定子电阻、电感、磁链就可以构建一个观测器来估计转子位置和转速。常见的观测器有滑膜观测器SMO、龙伯格观测器、扩展卡尔曼滤波EKF、模型参考自适应MRAS等。滑膜观测器因为实现简单、鲁棒性好在工程上用得最多。它的基本思路是根据电流误差构建一个滑膜面让估计电流跟踪实际电流当系统进入滑膜运动后反电动势的估计值就包含了转子位置信息再通过反正切或者锁相环PLL提取出角度和转速。但无感控制有个天生的短板低速和零速时反电动势太小信噪比差观测器根本算不准。所以无感FOC必须解决启动问题。常见的启动策略有开环强拖、高频注入、I/F启动等。开环强拖最简单但启动过程不可控负载重了可能失步高频注入能在零速下检测转子位置但对电机参数敏感实现也复杂。专栏后面会详细对比这几种方案。2.3 整体控制框图与信号流一个典型的无感FOC系统信号流大致是这样的ADC采样三相电流或者两相第三相通过基尔霍夫定律算同时采样母线电压。用估计的角度θ_est做Clarke变换和Park变换得到Id和Iq。Id_ref设为0表贴式PMSMIq_ref来自速度环PID的输出。电流环PID计算Vd和Vq。反Park变换得到Valpha和Vbeta。SVPWM模块根据Valpha、Vbeta和母线电压计算三相占空比。定时器输出PWM驱动逆变器。同时观测器根据Valpha、Vbeta和Ialpha、Ibeta估计反电动势进而得到θ_est和ω_est。速度环根据ω_est和速度给定做PID输出Iq_ref。这个闭环里观测器的精度直接决定了控制性能。如果角度估计有偏差Id和Iq的解耦就不彻底转矩输出会打折扣严重时甚至震荡失稳。实操心得调试无感FOC时建议先用有霍尔或者编码器的模式把电流环和速度环调好确认基本控制逻辑没问题再切到无感模式单独调观测器。这样能把问题隔离不然一堆参数搅在一起根本不知道哪里出了问题。3. 坐标变换与SVPWM的工程实现细节3.1 Clarke变换的等幅值还是等功率Clarke变换把三相静止坐标系abc变到两相静止坐标系αβ。这里有个选择等幅值变换还是等功率变换等幅值变换的系数是2/3变换后αβ的幅值等于三相正弦波的幅值。等功率变换的系数是sqrt(2/3)变换前后功率不变但幅值会变成原来的sqrt(3/2)倍。工程上大多数FOC代码用的是等幅值变换因为电流环的给定和反馈量纲一致PID参数好整定。具体公式Ialpha Ia Ibeta (Ia 2*Ib) / sqrt(3)这是基于Ia Ib Ic 0的简化形式。实际写代码的时候如果采样的是三相电流可以先算Ia和IbIc通过-Ia-Ib得到。如果只采样两相那就更直接了。有个细节要注意ADC采样的时机。PWM是中心对齐模式的话一般在计数器为零的时候触发ADC采样这时候开关管状态稳定电流纹波最小。如果采样时机不对采到的电流里全是开关噪声观测器根本没法用。3.2 Park变换与角度对齐Park变换把αβ变到dq依赖转子角度θId Ialpha * cos(θ) Ibeta * sin(θ) Iq -Ialpha * sin(θ) Ibeta * cos(θ)反Park变换Valpha Vd * cos(θ) - Vq * sin(θ) Vbeta Vd * sin(θ) Vq * cos(θ)θ的精度至关重要。有传感器的时候θ直接来自编码器但要注意对齐——编码器的零位和电机d轴不一定重合需要做一次对齐校准。无感的时候θ来自观测器观测器的收敛性和精度就是核心问题。注意Park变换里的θ是电角度不是机械角度。电角度 机械角度 × 极对数。这个搞错了电机要么不转要么乱转。我见过不止一个新手在这里翻车。3.3 SVPWM的原理与定时器配置SVPWMSpace Vector PWM和SPWM的区别在于SPWM是三相各自独立地和三角载波比较而SVPWM是把三相作为一个整体在六个基本电压矢量和两个零矢量之间切换合成目标电压矢量。SVPWM的直流电压利用率比SPWM高约15%谐波特性也更好。SVPWM的实现步骤根据Valpha和Vbeta判断目标矢量所在的扇区1到6。计算相邻两个基本矢量的作用时间T1和T2。计算零矢量作用时间T0 Ts - T1 - T2。根据扇区和作用时间计算三相占空比。在STM32上通常用定时器的中心对齐模式三个通道输出互补PWM带死区。定时器的ARR值决定PWM频率CCR值决定占空比。SVPWM算出来的占空比直接写入CCR寄存器。一个10kHz的PWM如果定时器时钟是170MHz中心对齐模式下ARR 170M / (2 * 10k) 8500。这个计算要搞清楚不然PWM频率不对电机啸叫或者发热。死区时间也很关键。死区是为了防止上下桥臂直通但死区会导致输出电压畸变低速时尤其明显。一般IGBT的死区在1-2微秒MOSFET可以小一些几百纳秒。死区补偿是个单独的话题专栏后面会展开讲。3.4 电流采样与ADC触发电流采样通常用采样电阻或者霍尔电流传感器。采样电阻成本低但要注意运放电路的带宽和共模抑制。霍尔传感器隔离性好但成本高。ADC触发时机前面提过中心对齐模式下在计数器为零时触发最合适。但要注意ADC采样和PWM更新之间的延迟这个延迟会导致角度估计滞后高速时影响明显。一般做法是在ADC中断里做坐标变换和电流环计算算完的占空比在下个PWM周期生效。如果MCU支持可以用定时器的触发输出直接触发ADC这样时序最精确。STM32的TIM1和TIM8都支持这种硬件触发。4. 无感观测器与启动策略的实战分析4.1 滑膜观测器的设计步骤滑膜观测器的核心是一个电流观测器d(Ialpha_est)/dt (Valpha - R * Ialpha_est - Ealpha_est) / L d(Ibeta_est)/dt (Vbeta - R * Ibeta_est - Ebeta_est) / L其中Ealpha_est和Ebeta_est是反电动势的估计值通过滑膜控制律得到Ealpha_est K_slide * sign(Ialpha_est - Ialpha) Ebeta_est K_slide * sign(Ibeta_est - Ibeta)当观测电流和实际电流的误差趋近于零时Ealpha_est和Ebeta_est就逼近真实反电动势。然后用反正切或者PLL提取角度θ_est atan2(-Ealpha_est, Ebeta_est)实际工程中sign函数会带来抖振通常用饱和函数或者Sigmoid函数代替。K_slide的选择要在收敛速度和抖振之间折中太大了抖振严重太小了收敛慢。实操心得滑膜观测器的参数整定我一般先把K_slide设大一点确认观测器能收敛然后逐步减小到刚好不震荡为止。另外观测器的带宽要低于电流环带宽不然会引入噪声。4.2 锁相环提取角度和转速直接用atan2算角度噪声大的时候角度会跳变。用PLL可以平滑角度和转速ε -Ealpha_est * cos(θ_est) - Ebeta_est * sin(θ_est) ω_est Kp_pll * ε Ki_pll * ∫ε dt θ_est ∫ω_est dtPLL的带宽决定了角度跟踪的速度和抗噪能力。带宽高了跟踪快但噪声大带宽低了平滑但动态响应慢。一般取电流环带宽的1/5到1/10。4.3 启动策略对比与选择无感FOC的启动是绕不开的坎。几种常见方案启动方案原理优点缺点适用场景开环强拖按固定频率和电压爬升实现简单负载能力差可能失步轻载、风扇类I/F启动控制电流幅值和频率比强拖稳定效率低切换有冲击中等负载高频注入注入高频信号检测凸极零速可用对凸极率敏感噪声大内置式PMSM脉冲注入施加短时脉冲检测饱和零速可用需要凸极有转矩脉动内置式PMSM表贴式PMSM凸极率低高频注入效果不好一般用开环强拖或者I/F启动。内置式PMSM凸极明显可以用高频注入实现零速启动。启动过程一般分三段预定位、开环加速、闭环切换。预定位是给一个固定角度通电流把转子拉到已知位置。开环加速是按一定斜率提升频率和电压。当转速达到观测器能正常工作的阈值一般是额定转速的5%-10%切换到闭环。切换瞬间是最容易出问题的地方。观测器的角度和开环角度如果不一致切换时会有一个转矩冲击严重时直接失步。我一般会在切换前让观测器先空跑一段时间等它的角度和开环角度接近了再切。4.4 低速和零速的观测器盲区反电动势和转速成正比低速时反电动势很小信噪比差滑膜观测器基本失效。这是物理规律决定的不是算法能完全解决的。所以低速段要么用高频注入要么用开环。有些方案会在低速时切换到I/F高速时切回无感中间做平滑过渡。高频注入的原理是利用电机的凸极效应d轴和q轴电感不同注入高频电压后高频电流的幅值包含转子位置信息。通过解调高频电流可以提取出角度。但表贴式PMSM的Ld和Lq几乎相等高频注入就不好使了。5. 调试过程中常见的坑与排查方法5.1 电机不转或者抖动最常见的原因角度不对。检查顺序确认极对数设置正确。有霍尔的话检查霍尔相序和角度对齐。无感的话检查观测器是否收敛K_slide和PLL参数是否合理。检查Park变换的θ符号是否正确sin和cos有没有搞反。另一个常见原因是电流环PID参数不对。P太大震荡I太大超调。我一般先把I设为0只调P让电流能跟踪上给定再加I消除稳态误差。5.2 电流波形畸变电流波形畸变可能来自几个方面死区时间过大导致输出电压非线性。低速时尤其明显需要死区补偿。ADC采样时机不对采到了开关噪声。电流传感器带宽不够或者运放电路有问题。SVPWM计算错误扇区判断或者作用时间算错了。用示波器看相电流波形是最直接的排查手段。正常的FOC相电流应该是平滑的正弦波如果有尖刺或者平顶就要往上面几个方向查。5.3 观测器震荡或者发散滑膜观测器震荡先检查K_slide是不是太大了。然后看电流采样的噪声如果噪声大观测器输入就不干净输出肯定抖。可以在电流采样后加低通滤波但滤波会引入相位滞后要折中。观测器发散一般是参数不对。定子电阻R和电感L如果和实际值差太多观测器模型就不准。建议先用LCR表测一下电机的实际参数或者用参数辨识算法在线辨识。5.4 启动失败或者切换失步启动失败先看预定位时间够不够电流够不够大。开环加速的斜率不能太陡否则转子跟不上。切换阈值不能太低观测器还没收敛就切肯定失步。我一般会在代码里加一些调试变量把开环角度、观测器角度、转速估计值都通过DAC或者串口输出用示波器或者上位机看波形。切换的时候如果两个角度差太多就说明观测器还没准备好需要调整切换条件。注意调试无感FOC一定要有隔离电源和示波器强电部分不是闹着玩的。第一次上电建议用低压小电流确认逻辑没问题再逐步加电压。6. 工具链与开源固件的参考价值6.1 STM32电机控制生态STM32的电机控制生态比较成熟ST官方有MCSDKMotor Control SDK里面包含了FOC的完整实现支持有感和无感。MCSDK的代码结构清晰可以作为参考但直接拿来用的话配置比较复杂而且有些部分封装得比较深想改算法不太方便。我个人的做法是参考MCSDK的框架但核心算法自己写这样可控性更强。STM32CubeMX可以配置定时器和ADC生成初始化代码省去不少底层配置的时间。6.2 VESC和Moteus的借鉴意义VESC是开源电调里比较有名的代码质量高功能全支持无感FOC。它的观测器实现和启动策略都值得参考。Moteus是另一个开源项目偏机器人关节应用控制精度要求高它的参数辨识和校准流程做得很好。看这些开源固件的时候不要只盯着算法它们的工程细节更值得学习比如怎么处理中断优先级、怎么做故障保护、怎么设计通信协议。这些在实际产品里比算法本身更重要。6.3 调试工具与测量手段示波器看PWM波形、相电流、反电动势。最好是四通道的能同时看多路信号。功率分析仪测效率、功率因数。如果没有用示波器的数学功能也能粗略估算。上位机通过串口或者CAN把调试变量传到电脑上用波形显示软件看趋势。我常用的是VOFA或者SerialPlot配置简单支持实时显示。电流探头非接触式测量相电流比采样电阻方便但要注意带宽和量程。6.4 参数辨识的简易方法电机参数R、L、磁链的准确性直接影响观测器性能。如果没有LCR表可以用简易方法辨识定子电阻R给电机通直流测量电压和电流R U/I。注意要等电流稳定后再测避免电感的影响。定子电感L给电机通高频交流测量电压和电流的幅值和相位差可以算出L。或者用阶跃响应法看电流上升的时间常数。磁链让电机空载旋转测量反电动势的幅值和频率磁链 E / ω。这些方法精度有限但比瞎猜强。如果条件允许还是建议用专业的电机参数测试仪。7. 我个人在无感FOC调试中的几点体会调无感FOC这几年最大的感受是理论要懂但不能死磕理论。很多问题不是算法层面的而是工程实现上的细节——采样时机差了几个微秒、死区补偿没做、中断优先级配错了这些都能让电机转不起来。另一个体会是调试要循序渐进。先把有传感器模式跑通再把电流环调好然后单独调观测器最后整合。每一步都确认没问题了再往下走不然出了问题根本定位不到。还有就是示波器是最好的朋友。很多问题看波形一目了然靠猜和试效率太低。我习惯在关键节点都留调试变量通过DAC输出随时能看内部状态。最后说一个容易被忽视的点温度。电机运行一段时间后定子电阻会随温度升高而增大观测器如果用的是冷态电阻高温时角度估计就会有偏差。要求高的场合需要做温度补偿或者用在线参数辨识。这个专栏后续会按模块逐步展开每篇尽量做到有理论、有代码、有波形、有踩坑记录。如果你也在搞FOC无感控制欢迎一起交流踩过的坑就不用再踩一遍了。