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，带宽±200Hz；LPF截止频率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中断意味着每个周期只有100us，F28335跑150MHz，100us有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的代码实现里，关键是滑模面的计算和等效控制的提取。滑模面用电流误差，等效控制用低通滤波提取。位置提取用PLL，PLL的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参数；二是加入故障诊断，比如高频注入收敛失败时自动切换到开环强拖；三是优化过渡策略，用模型预测或者模糊控制替代简单的权重切换。这些我还在尝试，有结果了再分享。
