1. 从零位起步为什么无感FOC的初始位置辨识是道绕不过去的坎搞过永磁同步电机无感控制的人都有一个共识低速域是块硬骨头。反电动势幅值跟转速成正比电机一旦转得慢反电动势小到几乎淹没在采样噪声里滑模观测器SMO估算出来的转子位置角基本没法用。更麻烦的是电机从静止启动那一瞬间——转子到底在哪个角度控制器完全不知道。有人可能会说那就开环强拖呗先转起来再切闭环。这个思路确实能用但问题在于如果初始位置偏差太大启动瞬间的转矩输出方向就是错的轻则抖动、异响重则直接堵转甚至退磁。尤其是带载启动或者需要正反转切换的场景开环强拖那套基本没法看。所以高频注入这条路就被逼出来了。它的核心逻辑是既然反电动势靠不住那就主动往定子绕组里注入一个高频电压信号利用永磁体造成的d轴和q轴电感差异凸极效应从高频电流响应里把转子位置抠出来。这个方法和转速无关静止状态下也能工作天然适合初始位置辨识和低速区域控制。我这次做的B1.1版本就是围绕这个思路搭了一套完整的全速域无感控制方案低速段用高频注入拿位置中高速段切到滑模观测器中间用权重函数做平滑过渡。硬件平台是TI的F28335标题里写的F283xC2000系列实际用的就是这颗经典款电机是一台内置式永磁同步电机IPM控制架构是标准的FOC。这篇文章我会把整个方案的来龙去脉拆开讲清楚——高频注入到底怎么注入、信号怎么解调、权重切换为什么不能硬切、SMO在低速为什么不行但在高速为什么好用、代码里哪些地方最容易翻车。如果你正在做类似的项目或者被无感FOC的低速启动问题卡住了这篇应该能帮你少走不少弯路。2. 高频注入辨识转子初始位置的底层逻辑与实现细节2.1 凸极效应高频注入能成立的物理基础高频注入能work根本原因在于IPM电机的d轴和q轴电感不相等。表贴式永磁电机SPM的Ld和Lq几乎一样凸极率接近1高频注入就非常吃力而IPM电机因为永磁体埋在转子内部磁路不对称Ld通常小于Lq凸极率一般在1.2到2.5之间这就给高频注入留出了足够的信号空间。具体来说当我们在估计的d轴方向注入高频电压时高频电流响应里会包含一个与转子实际位置偏差相关的分量。这个分量的幅值跟Ld、Lq的差值成正比相位里则编码了位置误差信息。通过解调这个高频电流就能提取出位置误差信号再经过锁相环PLL或者反正切运算就能收敛到真实转子角度。这里有个关键点注入频率的选择。频率太低会和基波、PWM谐波混在一起滤波分离困难频率太高开关损耗和铁损都会上去而且受限于PWM载波频率一般注入频率取载波频率的1/10到1/5比较合适。我这边载波用的10kHz注入频率选的1kHz实测下来信噪比和损耗的平衡点就在这个附近。2.2 旋转高频电压注入 vs 脉振高频电压注入高频注入有两大流派旋转注入和脉振注入。旋转注入是在α-β轴上注入一个旋转的高频电压矢量频率为ωh。它的优点是解调简单不需要知道估计角度直接对高频电流做同步解调就能拿到位置误差。但缺点是会产生高频转矩脉动低速时能听到明显的啸叫声而且对逆变器非线性比较敏感。脉振注入则是在估计的d轴方向注入高频电压q轴不注入。它的优点是转矩脉动小、噪声低而且解调出来的信号直接就是d轴偏差收敛性好。缺点是需要知道一个粗略的估计角度作为注入方向如果初始估计偏差太大超过±45度可能会收敛到错误的位置。我最终选的是脉振注入方案。原因有两个一是IPM电机的凸极率够大脉振注入的信号幅值足够二是这个方案后续切换到SMO的时候角度估计的连续性更好处理。旋转注入虽然初始收敛范围大但噪声和转矩脉动在实际产品里很难接受。2.3 信号解调链路从高频电流到位置误差脉振注入的完整信号链路大致是这样的注入环节在估计的d轴方向叠加一个高频电压Vd_inj Vh * cos(ωh * t) Vq_inj 0其中Vh是注入幅值ωh是注入角频率。电流响应高频激励下电机模型可以简化为纯电感模型高频时电阻和反电动势都可以忽略。高频电流响应里会包含一个与位置误差Δθ相关的分量Ih_alpha Ih * sin(ωh * t) * cos(Δθ) Ih_beta Ih * sin(ωh * t) * sin(Δθ)解调环节把采样到的三相电流经过Clarke变换到α-β轴然后用一个中心频率为ωh的带通滤波器BPF把高频分量提取出来。接着乘以同步解调信号sin(ωh*t)再经过低通滤波器LPF就能得到包含位置误差的信号ε ≈ K * sin(2 * Δθ)当Δθ很小时ε正比于2Δθ这就是位置误差信号。位置跟踪把ε送入一个PI控制器本质上是锁相环输出估计转速再积分得到估计角度。PI参数调好后估计角度会快速收敛到真实角度。整个链路里带通滤波器和低通滤波器的设计是重中之重。BPF的带宽太窄收敛慢太宽基波和谐波滤不干净。LPF的截止频率决定了位置环的带宽太低响应慢太高噪声大。我这边BPF用的是二阶巴特沃斯中心频率1kHz带宽±200HzLPF截止频率50Hz实测收敛时间在200ms以内静态精度能到±3度电角度。2.4 初始位置辨识的完整流程初始位置辨识不是一上来就闭环收敛的需要分阶段来第一阶段预定位。先给d轴一个固定的直流电流比如额定电流的30%持续几百毫秒把转子强行拉到d轴对齐的位置。这一步的目的是把转子位置误差缩小到脉振注入能收敛的范围内±45度以内。预定位电流不能太大否则发热严重也不能太小否则拉不动负载。第二阶段高频注入收敛。撤掉直流切换到高频注入模式。此时估计角度从预定位的位置开始PI控制器开始工作逐步收敛到真实角度。这个阶段大概需要100到300ms取决于PI参数和负载情况。第三阶段精度校验。收敛完成后可以做一个简单的校验在估计的d轴注入一个小幅度的正负脉冲观察电流响应是否对称。如果对称说明估计角度准确如果不对称说明还有偏差需要继续收敛或者调整PI参数。注意预定位阶段如果负载惯量很大或者有静摩擦力转子可能拉不到位。这时候可以适当加大预定位电流或者延长预定位时间但要注意电流不能超过电机的退磁电流。3. 低速区域的高频注入闭环与权重切换策略3.1 低速段为什么必须用高频注入而不是SMO滑模观测器的原理是基于反电动势估算转子位置。反电动势E ωe * ψf其中ωe是电角速度ψf是永磁磁链。电机转速越低反电动势越小。当转速降到额定转速的10%以下时反电动势可能只有几伏甚至更低而采样噪声、死区效应、逆变器非线性带来的干扰可能有几十毫伏甚至上百毫伏。信噪比太低SMO的估算精度就崩了。具体来说SMO在低速段的问题有三个信噪比不足反电动势幅值接近噪声水平滑模面抖振严重估算角度波动大。低速抖振滑模增益需要足够大才能保证收敛但增益大了抖振也大低速时尤其明显。死区效应低速时相电流小死区导致的电压误差占比大进一步恶化了估算精度。所以低速段一般定义为额定转速的0%到15%左右必须用高频注入来接管。高频注入不依赖反电动势静止和低速都能工作这是它的天然优势。3.2 权重切换为什么不能硬切当转速从低速往中高速爬升时需要从高频注入平滑过渡到SMO。如果直接硬切会出现两个问题一是角度跳变。高频注入和SMO估算出来的角度在同一时刻可能有几度甚至十几度的差异硬切会导致角度突变电流环和速度环都会受到冲击表现为转矩抖动甚至失控。二是控制量不连续。高频注入模式下d轴电压里叠加了高频分量SMO模式下没有这个分量。硬切会导致电压指令突变PWM波形也会突变。所以必须用权重函数做平滑过渡。我用的方案是θ_est w * θ_hfi (1 - w) * θ_smo其中w是权重系数随转速变化w 1, 当 ωe ω1 w (ω2 - ωe) / (ω2 - ω1), 当 ω1 ≤ ωe ≤ ω2 w 0, 当 ωe ω2ω1和ω2是切换区间的上下限。我这边ω1取额定转速的10%ω2取20%。切换区间不能太窄否则过渡太快冲击大也不能太宽否则两种方法都在工作互相干扰。提示权重切换的时候两个观测器的角度必须做角度归一化处理确保都在[-π, π]范围内否则加权平均会出现角度跳变。3.3 切换区间的实测调参经验切换区间的选择直接影响到过渡的平滑性。我一开始把ω1和ω2设得很近10%和12%结果切换太快电流波形上能看到明显的畸变。后来把区间拉宽到10%到20%过渡就平滑多了。但区间也不能太宽。如果ω1设得太低比如5%高频注入在5%以下才工作那5%到10%这段SMO还没完全收敛角度精度不够。如果ω2设得太高比如30%高频注入在30%以下都在参与那高频损耗和噪声就一直存在。实测下来10%到20%这个区间对大多数IPM电机都适用。当然具体值还要看电机的凸极率和额定参数凸极率大的电机可以适当降低ω1因为高频注入信号强低速精度好。另外权重函数的形状也有讲究。线性过渡是最简单的但也可以用S形曲线sigmoid或者余弦过渡过渡更平滑。我试过余弦过渡效果比线性好一点但差别不大线性就够用了。3.4 高频注入在低速段的实际表现低速段额定转速的5%以下高频注入的角度精度我实测下来静态能到±3度电角度动态转速变化时大概±5度。这个精度对于低速控制来说够用了毕竟低速时对转矩脉动的要求没那么高。但有几个坑要注意注入幅值不能太大注入电压幅值一般取额定电压的10%到20%。太大了电流谐波和噪声都上去了太小了解调信噪比不够。我这边取的是15%。电流采样要同步高频注入的解调对电流采样时刻很敏感。采样时刻如果和PWM不同步高频电流的相位就错了解调出来的位置误差也是错的。我这边用的是PWM中点采样和载波同步效果最好。滤波器相位延迟要补偿BPF和LPF都会引入相位延迟这个延迟会直接反映到角度估计上。我这边在解调后加了一个相位补偿环节根据滤波器参数和注入频率计算补偿角实测能改善3到5度的精度。4. 滑模观测器在中高速段的接管与工程实现4.1 SMO的基本原理与适用边界滑模观测器的核心思想是构造一个电流观测器让观测电流和实际电流的误差在滑模面上收敛到零。收敛之后观测器里的等效控制量就包含了反电动势信息从反电动势里就能提取转子位置和转速。SMO的数学表达不复杂但工程实现里有几个关键点滑模面设计一般用电流误差作为滑模面s î - i。滑模增益要足够大保证到达条件满足。等效控制滑模面上的高频切换项经过低通滤波后得到等效控制量这个量里包含反电动势。位置提取从等效反电动势里用反正切或者PLL提取角度。SMO的适用边界很明确反电动势要足够大信噪比要够。所以它适合中高速段一般从额定转速的15%到20%以上开始接管。4.2 滑模增益与抖振的平衡滑模增益Kslide是SMO里最关键的参数。增益越大收敛越快鲁棒性越好但抖振也越大。抖振会直接反映到估算角度上导致角度波动进而影响电流环和速度环。我调这个参数的经验是先从理论值开始。理论增益一般取反电动势最大值的1.5到2倍。然后看电流误差的收敛情况。如果收敛慢适当加大如果抖振明显适当减小。最后看估算角度的波动。用示波器看角度波形波动在±2度以内可以接受。我这边最终用的增益是理论值的1.8倍实测角度波动在±1.5度左右电流波形也干净。另外滑模观测器里的低通滤波器截止频率也要调。截止频率太低相位延迟大角度估计滞后太高高频抖振滤不干净。我这边截止频率取的是基波频率的3到5倍随转速自适应调整。4.3 从高频注入到SMO的过渡实测过渡段的实测是最能暴露问题的。我在调试的时候遇到过几个典型现象现象一过渡段电流畸变。在切换区间内电流波形上能看到明显的毛刺。排查后发现是两个观测器的角度在切换瞬间有差异加权平均后角度不连续。解决办法是在切换前先让两个观测器同步收敛确保角度差异在2度以内再开始加权。现象二转速波动。过渡段转速有±20rpm的波动。原因是两个观测器的转速估计也有差异加权后转速指令波动。解决办法是对转速也做加权而且转速的权重函数比角度更平滑一些。现象三负载突变时过渡失败。空载过渡没问题一加负载就失败。排查后发现是SMO在负载下的收敛速度不够切换时SMO还没完全收敛。解决办法是提前让SMO参与运算但不参与控制等它收敛好了再开始加权。这些现象在文档里基本不会写但实际调试中很容易遇到。我的建议是过渡段一定要留足够的调试时间用示波器同时看角度、转速、电流三个量逐个排查。4.4 SMO在高速段的精度与动态响应中高速段SMO的表现我实测下来角度精度能到±1度电角度动态响应转速阶跃大概50ms恢复到稳态。这个性能对于大多数工业应用足够了。但SMO在高速段也有边界。转速太高的时候PWM频率和采样频率的限制会导致角度分辨率下降。我这边载波10kHz最高转速对应的电频率是500Hz每个电周期只有20个采样点角度分辨率大概18度。虽然SMO本身能插值但精度还是会受影响。如果转速再高就得考虑提高载波频率或者用其他方法了。5. 全速域控制的代码架构与调试踩坑记录5.1 F28335上的代码架构设计F28335是TI C2000系列的经典款150MHz主频浮点运算能力对于FOC来说够用。我的代码架构大致分三层底层驱动层PWM配置、ADC采样、定时器中断。PWM用ePWM模块载波10kHz死区时间2us。ADC用12位模式采样时刻和PWM中点同步。中断服务函数里完成电流采样和Clarke/Park变换。控制算法层电流环PI、速度环PI、高频注入解调、SMO、权重切换。这一层是核心全部用浮点运算中断频率10kHz。状态机层预定位、高频注入收敛、低速闭环、过渡段、中高速闭环。状态机负责模式切换和故障处理。代码里最关键的是中断服务函数的执行时间。10kHz中断意味着每个周期只有100usF28335跑150MHz100us有15000个时钟周期。电流环、SMO、高频注入解调加起来大概用掉60%到70%的CPU时间剩下的留给状态机和通信。如果算法再复杂一点就得考虑优化或者提高主频了。5.2 高频注入和SMO的代码实现要点高频注入的代码实现里最麻烦的是滤波器。BPF和LPF都是用差分方程实现的系数需要根据注入频率和采样频率计算。我这边BPF用的是二阶巴特沃斯差分方程// 二阶带通滤波器差分方程 y[n] b0*x[n] b1*x[n-1] b2*x[n-2] - a1*y[n-1] - a2*y[n-2]系数b0、b1、b2、a1、a2根据中心频率和带宽计算。LPF同理用的是一阶或者二阶巴特沃斯。SMO的代码实现里关键是滑模面的计算和等效控制的提取。滑模面用电流误差等效控制用低通滤波提取。位置提取用PLLPLL的PI参数要调好否则角度收敛慢或者振荡。权重切换的代码最简单就是一个加权平均// 权重切换 float w calc_weight(speed); theta_est w * theta_hfi (1 - w) * theta_smo; speed_est w * speed_hfi (1 - w) * speed_smo;但要注意角度归一化确保两个角度都在[-π, π]范围内否则加权平均会出错。5.3 调试过程中踩过的坑坑一ADC采样时刻不对。一开始ADC采样时刻设在PWM周期开始结果高频电流的相位完全错了解调出来的位置误差是乱的。后来改成PWM中点采样问题解决。原因是PWM中点时电流纹波最小采样最准。坑二滤波器系数算错。BPF的系数一开始用手算的结果中心频率偏了100Hz解调信噪比很差。后来用MATLAB重新算了一遍问题解决。建议滤波器系数一定要用工具算手算容易出错。坑三预定位电流太大。一开始预定位电流设的额定电流的50%结果电机发热严重而且有退磁风险。后来降到30%效果一样发热小多了。坑四切换区间太窄。前面说过一开始切换区间只有2%过渡时电流畸变严重。后来拉宽到10%问题解决。坑五SMO增益太大。一开始增益设得太大角度抖振明显电流波形毛刺多。后来降到理论值的1.8倍抖振和收敛速度的平衡就好了。坑六中断优先级冲突。F28335的中断优先级如果没配好ADC中断和PWM中断会冲突导致采样时刻漂移。后来把PWM中断设为最高优先级问题解决。这些坑在文档里基本不会写但实际调试中很容易遇到。我的建议是每个模块单独调试确认没问题再联调。尤其是高频注入和SMO单独调好了再切切换逻辑否则问题定位很困难。5.4 实测波形与性能数据最终方案的实测数据指标数值初始位置辨识精度±3度电角度低速段10%额定转速角度精度±5度电角度中高速段角度精度±1.5度电角度过渡段转速波动±20rpm过渡段时间约200ms静态启动成功率100%空载和半载动态切换成功率100%转速阶跃波形方面低速段电流波形有高频纹波注入导致的但基波正弦度良好。中高速段电流波形干净THD在5%以内。过渡段电流波形平滑没有明显畸变。6. 几个容易被忽略的工程细节与个人经验6.1 电机参数变化对高频注入的影响高频注入依赖Ld和Lq的差异但Ld和Lq会随电流饱和而变化。负载越大电流越大电感饱和越严重凸极率可能下降。我实测过满载时凸极率比空载时下降了大概15%高频注入的信号幅值也相应下降位置精度会变差。解决办法有两个一是根据电流大小动态调整注入幅值电流大时适当加大注入二是根据电流大小调整PI参数保证收敛速度。我这边用的是第一种简单有效。6.2 温度对永磁磁链的影响SMO依赖永磁磁链ψf但ψf会随温度变化。温度每升高1度ψf大概下降0.1%。如果温度变化范围大比如从-20度到120度ψf的变化可能有10%到15%SMO的估算精度会受影响。工程上的解决办法是加温度补偿。如果电机里有温度传感器可以直接测磁钢温度然后查表补偿ψf。如果没有温度传感器可以用定子电阻估算温度定子电阻也随温度变化间接补偿。我这边用的是后者精度差一点但够用。6.3 死区补偿对低速性能的改善低速时相电流小死区导致的电压误差占比大会恶化高频注入的解调精度。我加了死区补偿之后低速段的角度精度改善了大概2度。死区补偿的方法不复杂根据电流方向在电压指令上叠加一个补偿量。补偿量的大小等于死区时间乘以母线电压除以PWM周期。方向根据电流极性判断。注意电流过零时补偿量要平滑过渡否则会引入新的畸变。6.4 个人经验总结做了这个项目之后我最大的体会是无感FOC的全速域控制难点不在单个算法而在算法之间的衔接。高频注入和SMO单独拿出来都不难但要让它们在切换的时候不打架需要花大量时间调试。另外仿真和实测的差距很大。仿真里滤波器是理想的采样是同步的没有噪声和延迟。实测里这些都是问题。所以我的建议是仿真可以帮你理解原理但参数一定要在实测里调。最后调试工具很重要。我用的是示波器加DAC输出把关键变量角度、转速、电流实时输出到示波器上看。没有这个调试效率会低很多。F28335有DAC输出功能或者用PWM加RC滤波也行总之要能看到实时波形。这个方案后续还可以扩展的地方一是加入参数自适应根据工况自动调整注入幅值和PI参数二是加入故障诊断比如高频注入收敛失败时自动切换到开环强拖三是优化过渡策略用模型预测或者模糊控制替代简单的权重切换。这些我还在尝试有结果了再分享。