BLDC直流无刷电机FOC控制 在Matlab/Simulink中实现了无刷直流电机的磁场定向控制FOC，整个FOC架构包括： 1、估计：根据霍尔传感器信号估计转子位置、角度和电机速度； 2、诊断：执行错误检测，如霍尔传感器未连接、电机阻塞、MOSFET故障； 3、控制管理器：管理控制模式（电压、速度、扭矩）之间的转换； 4、FOC算法：实施FOC策略； 5、控制类型管理器：管理换向、正弦和FOC控制类型之间的转换； FOC（磁场定向控制）算法，具有以下3种控制模式： 电压模式：在此模式下，控制器向电机施加恒定电压。 速度模式：在此模式下，闭环控制器通过拒绝施加到电机的任何干扰（电阻负载）来实现输入速度目标。 扭矩模式：在此模式下，实现输入扭矩目标。 当扭矩目标为“0”时，该模式启用电机“空转”。 诊断 不断监测电机是否存在错误。 这些错误包括： 错误001：霍尔传感器未连接； 错误002：霍尔传感器短路； 错误004：电机无法旋转（可能原因：电机相位断开、MOSFET故障、运算放大器故障、电机堵塞。
玩过BLDC电机的老铁都知道，FOC控制这玩意儿就是个既要懂理论又要会实操的活儿。今天咱们直接上干货，拆解下我在Matlab/Simulink里搭的这套FOC系统，保准让你看到代码比看原理图还带劲。
先看这个转子位置观测模块，霍尔信号处理绝对是个玄学环节。之前用M代码写的角度估算函数翻过车，后来改成了Simulink自带的Sensor Decoder模块：
function theta = hall2angle(hallABC) % 霍尔信号转机械角度查表法 hall_state = bi2de(hallABC); angle_map = [0, 60, 120, 180, 240, 300]; theta = angle_map(hall_state+1); end这段代码坑点在于霍尔信号跳变时的毛刺处理，必须得加个数字滤波器。实测发现当电机转速超过3000rpm时，用IIR滤波比移动平均靠谱，窗口大小设置成电周期1/4最稳。
诊断模块绝对是系统的安全卫士，咱给错误检测写了个状态机：
if any(HallVoltage < 0.3) error_code = bitor(error_code, 1); % 错误001触发 end if RPM < 50 && abs(Iq) > 0.5 && t > 0.1 error_code = bitor(error_code, 4); % 错误004砸场子 end这里有个骚操作——用电流环的积分项当堵转检测指标。当q轴电流持续高位但转速上不去，八成是电机卡死了，比单纯看转速阈值灵敏得多。
控制模式切换这块必须丝滑，搞不好会炸MOS管。咱们用状态迁移图实现的模式切换，核心是这个transition函数：
function mode = controlModeSwitch(current_mode, cmd) transition_matrix = [ % Voltage Speed Torque [1, 2, 3]; % From Voltage [1, 2, 3]; % From Speed [1, 2, 3] % From Torque ]; mode = transition_matrix(current_mode, cmd); end重点在于切换瞬间的变量保持策略，速度模式切扭矩模式时要把速度环的输出作为扭矩环的初始值，不然会产生转矩突变。
说到FOC核心算法，Clarke变换千万别用教科书写法，得考虑计算效率：
function [I_alpha, I_beta] = clarke_transform(Ia, Ib, Ic) I_alpha = Ia; I_beta = (Ib - Ic)/sqrt(3); % 优化掉乘法运算 endPark变换里角度补偿是个魔鬼细节，实测发现当电机高速旋转时，用预测角度比当前角度更稳，补偿公式θcomp = θ + ωTsample0.5能有效减少相位滞后。
最刺激的还是扭矩模式空转的实现，当目标扭矩设零时：
if Torque_ref == 0 Vd = 0; Vq = 0; enable_brake = false; % 关断所有PWM end这时候电机就跟断了线的风筝似的自由旋转，但要注意反电动势可能会让母线电压飙升，得加个主动短路保护。
最后给新手提个醒：FOC参数整定别急着调PI，先把观测器带宽和电流采样频率匹配好。遇到诡异震荡时，八成是SVPWM的死区时间没设对，用这个公式校准：
DeadTime = (1e9/(PWM_freq1e6))0.07 + 20; % ns单位计算
这套系统在四轴电机上跑过实测，从零速到20000rpm切换只要0.2秒，抗负载扰动比六步换向强了不止一个档次。代码虽然看着不复杂，但每个变量背后的物理意义得门儿清，不然调参调到头秃也搞不定。
