永磁同步电机无感FOC全速域控制：高频注入与滑模观测器切换策略

做永磁同步电机无感FOC控制最难受的环节永远是零速到低速这一小段。电机静止时反电动势为零靠反电动势估算转子角度的方法在此时全部失效而现场要求往往很直接电机停在任意位置就得能带负载直接转起来。这个B1.1工程就是在TI C2000系列DSP平台上做的一套全速域无感控制方案低速段用高频注入HFI完成转子初始位置辨识并闭环运行中高速段切换为滑模观测器SMO中间加上权重切换做平滑过渡。整套方案代码命名是TIDSP_F283xC2000_IPM_FOC_Sensorless_V1.0我按C2000系列的F2837x平台完成的调试F2833x、F28004x这些器件也能参考移植。这篇文章把方案架构、高频注入与初始位置辨识、低速闭环与权重切换、SMO参数整定、C2000代码结构、调试踩坑都拆开写出来给正在做PMSM无感FOC的工程师和实验室学生做个参考。1. 全速域无感FOC的方案架构为什么要把控制拆成三个阶段1.1 反电动势法的天然瓶颈与高频注入的补位逻辑PMSM无感控制的主流思路是依靠反电动势或磁链来观测转子位置但这套思路有一个物理前提电机必须转起来转子磁链得切割定子绕组才能产生可观测的反电动势。零速和极低速时反电动势幅值接近零别说精确解算角度连信噪比都过不了关。这也是许多无感方案在启动瞬间需要依赖强行拖动的根本原因。高频注入解决的正是这个问题。它不去测量反电动势而是主动在定子侧叠加一个高频电压信号利用转子磁路凸极性引起的电感差异从电流响应里解算出转子角度。对于内置式IPM电机d/q轴电感差天然存在高频注入非常合适对于表贴式PMSM磁路凸极性虽然很弱但通过磁饱和效应也能在d轴上形成足够观测的差异。正因为高频注入对转速不敏感电机不转也能工作所以这套方案把起点直接设在零速补上了传统反电动势法最缺的一块短板。整个控制段位因此被我切成了三块零速到低速用高频注入闭环中高速用滑模观测器闭环中间留一段转速区域用权重切换做软过渡。版本号里的“全速域”指的就是由多个观测方法拼接出的完整转速范围而不是某一个算法从头包到尾。1.2 控制器整体信号流与版本能力边界整套系统的信号流是标准FOC结构三相电流采样Clarke变换到αβ坐标系根据当前估算角度做Park变换电流环PI调节反Park输出参考电压SVPWM送往IPM逆变器。区别只在于“当前估算角度”来自哪里——低速段来自高频注入环路解调出的θ_HFI高速段来自滑模观测器输出的θ_SMO切换区间则用权重系数α做线性融合。对比这两个观测方法可以看得很清楚对比项高频注入HFI滑模观测器SMO适用转速零速起至中低速中高速段依赖物理量d/q轴电感差凸极性反电动势零速性能可以稳定运行完全失效动态响应解调带宽有限不适合高速带宽可做高但低速信噪比差主要风险高频噪声、电流发散抖振、角度相位滞后这个B1.1版本的能力边界我在工程文档里写得很明确支持零速启动、0.2倍额定转速以下的稳定带载运行0.8倍额定转速以上连续稳定运行切换段在0.1到0.2倍额定转速内完成过渡。至于转速突变、负载转矩阶跃这类比较严苛的动态工况这一版还没有完全收敛属于后续迭代内容。做版本管理时把能力边界记录清楚很重要否则后续测试的人会把动态性能不足当成Bug来报整个项目沟通成本会非常大。2. 高频注入转子初始位置辨识把静止位置从电感差里解出来2.1 为什么选择高频电压方波注入而不是高频正弦注入高频注入在实现上主要有两类旋转高频电压注入和脉振高频方波注入。旋转注入需要在电机端产生一个空间旋转的高频电压矢量位置信息要经过带通、外差解调等一系列处理计算量大调起来也烦。脉振方波注入则直接得多在估计d轴方向叠加一个正负交替的高频方波电压采样对应的高频电流响应通过差分关系直接得到位置误差。这套B1.1版本用的是脉振方波注入核心原因是好落地。方波不像正弦那样需要精确的正弦表或DAC输出直接在中断里周期性切换电压极性就行数字解调也简单把两个半周期的高频电流响应做差差值里天然包含Δθ项不需要复杂的外差处理。还有一个工程层面的理由方波注入的等效频率可以比旋转正弦注入做得更高便于避开电流环带宽和开关噪声的干扰频段。我的样机上注入频率是1kHzPWM频率是10kHz也就是十个开关周期一个完整注入周期电流采样毛刺相对容易滤除。注入信号加在估计d轴还是q轴这两种选择在不同论文里都有支持。我的实测经验是加在估计d轴因为对负载力矩变化不敏感低速带载时收敛方向也更稳定。高频电压幅值不能拍脑袋决定太小电流响应会被采样噪声淹没太大会产生明显电磁噪声、振动和额外损耗。我的起点是额定电流对应阻抗压降的5%到8%在10kHz PWM、1kHz注入频率下典型幅值在8到15V之间具体要按母线电压和相电感折算。2.2 位置误差信号提取与PLL参数计算过程高频方波注入的点在于电流响应中包含位置误差信息。设估计角与实际角偏差为Δθ在估计d轴注入高频方波电压时q轴高频电流响应的幅值近似正比于sin(2Δθ)而d轴高频电流幅值近似正比于电感平均项。因此工程上常把q轴高频电流与注入脉冲符号相乘再做低通滤波得到的就是与Δθ成比例小角度近似下的误差信号ε。把ε喂给锁相环PLL收敛后输出的角度就是转子位置估计值。PLL带宽是高频注入里最关键的参数。带宽太低角度跟踪跟不上转速变化启动会滞后带宽太高高频残留分量会污染输出角度导致电流波动。我的设计方法是目标PLL带宽取30到60Hz阻尼比取0.7左右。离散化采用Tustin变换PI参数粗略按Kp_pll约等于2π乘以带宽再乘以2倍阻尼比Ki_pll约等于2π乘以带宽的平方来设。需要注意PLL前面往往还串了常规低通滤波器所以PLL带宽别超过前面低通截止频率的一半否则环路稳定性迟早出问题。2.3 初始位置辨识完整流程与磁极判断初始位置辨识本质上分两步角度粗辨识加极性校验。角度粗辨识利用凸极性判断出转子轴线方向但凸极响应是周期为π的信号只能判断到轴线区分不了N极还是S极。因此还需要磁极性判断在轴线正反两个方向分别施加相同的电压脉冲测量电流响应上升率。因为磁饱和效应与磁链方向一致时电感更小、di/dt更大对比两个方向的响应就能确定真实的N/S方向。这一步是个很容易翻车的地方。如果直接拿粗辨识角度去启动碰到磁极判断错误的情况电机在闭环瞬间会出现反向误动作轻则转矩跳动重则过流报警。我的程序里把极性判断做成了独立功能连续做三组脉冲比较结果至少两次一致才算通过否则重新辨识。辨识期间电流环不闭环直接开环发脉冲电流限制在额定电流的20%左右既不会把电机推起来又能保证采样精度。3. 低速闭环与权重切换策略让两个观测器交接不翻车3.1 低速高频注入闭环的控制结构辨识出初始位置后电机必须立刻进入闭环否则位置信息会随着电流变化慢慢失真。低速段在控制上就是普通FOC电流环加转速环只是用来做Park变换的角度不是编码器给的而是高频注入PLL实时输出的θ_HFI。这一步我把电流环带宽设在300到500Hz比高速段略低。因为高频注入角度本身有一定时延和纹波电流环带宽如果太高很容易跟着角度纹波走产生额外的电流噪声和损耗。转速环在低速段同样要压一压带宽。低速运行本身不要求转速环有多快稳定不抖动才是第一位。我的做法是把低速转速环带宽控制在5到10Hz速度环输出加限幅避免启动瞬间PI积分饱和导致电流暴走。等运行到切换区后再按系数逐步放开让系统平滑过渡到高速运行状态。3.2 权重切换的离散化实现与计算过程权重切换要解决的核心问题是在某个转速窗口内让估算角度从θ_HFI平滑过渡到θ_SMO。定义一个低转速门限n_low和一个高转速门限n_high比如0.1pu和0.2pu当前转速为n权重系数α的计算方式就是float alpha; if (n_speed_hz N_LOW_PU) { alpha 0.0f; } else if (n_speed_hz N_HIGH_PU) { alpha 1.0f; } else { alpha (n_speed_hz - N_LOW_PU) / (N_HIGH_PU - N_LOW_PU); } theta_est (1.0f - alpha) * theta_hfi alpha * theta_smo; omega_est (1.0f - alpha) * omega_hfi alpha * omega_smo;α0时完全用HFI角度α1时完全用SMO角度中间区间按线性插值。速度估算值同样按α融合这一步很关键否则速度环反馈源切换时积分状态突变会有明显的转速抖动。这里有一个工程细节θ_HFI和θ_SMO都是周期量直接线性插值在两个角度跨0°到360°边界时会跳变。我的处理是先看两者差值如果差值大于π就把其中一个角度按2π补偿到同一周期内再做插值否则电机在切换区间可能莫名其妙抖动一下。这个坑在仿真里不太容易暴露真机上板后非常明显。3.3 切换窗口调参的几个注意点权重切换最容易被忽略的是切换窗口两侧观测器带宽的差异。SMO在低速刚介入时反电动势信噪比很差角度抖动大HFI在中高速段又因为旋转频率逐渐接近高频注入频率解调性能断崖式下跌。所以切换窗口不是越大越好也不是越小越安全。我在这版里把切换窗口从0.08pu到0.25pu逐步缩小到0.1pu到0.2pu才算找到平衡点。窗口太小SMO角度还没稳定就完全接管容易过流窗口太大HFI在窗口后半段的抖动又会在速度环里引起周期性转速波动。切换过程中的转矩限幅同样重要。带载启动到切换段时如果负载转矩比较大角度融合过程里哪怕只有3到5度的偏差也会造成可感知的转矩波动。我在转速环输出后面加了一个按α调整的限幅函数让转矩指令在切换段不要突变。实际体验是高速接管时的动静明显变小电流包络也平滑不少。4. 滑模观测器SMO参数整定从符号函数到工程稳定的关键4.1 SMO状态方程与反电动势提取原理SMO部分基于αβ坐标系下的PMSM电流方程。先把电机按表贴式近似忽略凸极效应方程可以写为d(iα)/dt (-Rs*iα - eα uα) / Ls d(iβ)/dt (-Rs*iβ - eβ uβ) / Ls其中反电动势eα、eβ包含转子磁链和转速信息eα -ψfωesin(θe)eβ ψfωecos(θe)。用电压和电流构造电流观测器让观测电流与实际电流做差得到滑模面采用符号函数作为切换控制稳定后电流观测误差会被拉到滑模面上此时等效控制量中就包含反电动势信息。工程实现上我是在电流环控制模型之外复制一份离散化电流模型每个中断周期算出观测电流再与实际采样电流求差。反电动势提取出来之后既可以直接用atan2(eβ, eα)求角度也可以再接一个锁相环。直接反正切实现简单但噪声会被原始放大加PLL能平滑角度还能顺便得到转速估计值。我在B1.1版本里选的是低通滤波加锁相环的组合虽然多几步计算但角度抖动和转速噪声都小很多调试时省了不少精力。4.2 滑模增益k的选取与自适应策略滑模增益k是整个SMO里最敏感的参数。它必须大于系统扰动和反电动势幅值的上限否则滑模面不可达观测器会退化成普通PI状态估计角度出现偏移。但k如果取太大符号函数切换幅度增大电流观测误差虽然被强行压到零反电动势里的抖振分量同样变大锁相环输出的角度会跟着高频抖。我用的整定方法是分两步走。先在额定转速、额定负载下记录反电动势峰值E_max然后把k设为1.2到1.5倍的E_max留出裕量再在空载和满载之间反复切换如果观测电流出现明显高频噪声就把k往回调直到抖振刚好能被后续低通滤波器压住。为了照顾切换段程序里把k做成转速的函数低速段按比例缩小避免SMO刚接管时把HFI那边的噪声放大。4.3 抖振抑制连续化滑模面与相位滞后补偿工程实现上很少直接用纯sign函数否则观测器在微弱扰动下就会高速切换反电动势解算结果会非常难看。比较稳妥的做法是用饱和函数近似符号函数滑模误差远离零点时输出±1接近零点时做线性过渡。过渡带宽度δ要合适太窄起不到平滑效果太宽会把滑模控制变成滑模-线性混合削弱抗扰动能力。我在实测中把δ取成电流标幺值的0.01到0.02之间效果比较理想。反电动势滤波和角度补偿是另一个常见的失分点。低通滤波器必然带来相位滞后滞后大小与转速相关转速越高滞后角度越大。如果忽略这一点高速时角度会持续滞后电流环和速度环的状态变量一起偏移在速度拐点处很容易过流。我在代码里加了一个基于转速查表的相位补偿量补偿角度按等效滤波时间常数计算前期标定后固定使用比实时自适应简化很多也够用。5. TI DSP F283xC2000平台落地中断、ADC、PWM与代码模块怎么排5.1 中断架构与ADC采样触发配置这套系统的核心控制代码全部放在PWM中断里中断频率10kHz。PWM配置成中心对齐模式三相电流采样通道对应的ADC输入引脚触发点设在计数器上溢时刻也就是PWM周期的中心点。这一步是为了避开开关管导通和关断瞬间的电流振铃。配置C2000时ADC触发源与PWM的相位关系必须仔细核对如果触发点落在开关边沿采样到的相电流会叠加明显毛刺。高频注入辨识本身靠的就是微弱电流差毛刺严重时会直接把位置解算结果埋掉。死区模块也建议直接复用PWM内部死区生成单元不要用软件控制上下管逻辑。死区时间按IPM数据手册给出的最小死区再加0.5微秒裕量设置。高频注入与死区之间还有一个容易忽略的耦合死区带来的电压误差是非线性的补偿不准确时在注入半周期切换瞬间会产生与位置无关的电压扰动最终给位置辨识引入固定偏差。B1.1版本里我把死区补偿做成基于相电流极性的查表补偿再和母线电压归一化一起完成效果比单纯固定补偿稳。5.2 电流环、速度环的离散化与PI参数工程化连续域PI参数落到DSP中断里时需要考虑离散化方法和执行顺序。电流环对采样到执行的时延非常敏感所以我用前向欧拉离散化Kp和Ki直接按计算步长Ts100微秒换算速度环带宽低用Tustin离散化抗积分饱和和输出限幅放在同一节里避免速度环PI在启动阶段把积分项攒爆。我在这套样机上实际调试用的参考参数是这样的额定电流10A、极对数2、相电感5mH、相电阻1欧。电流环带宽约500Hz时Kp取2.5左右Ki取800左右速度环带宽约15Hz时Kp取0.15Ki取3。注意这组参数是标幺化后的结果直接抄到别的电机上不一定合适但比例关系可以参考。C2000浮点器件上实现时关键路径全部用单精度如果项目强制定点PI输出按Q24格式缩放特别注意中间乘法不要溢出。5.3 状态机设计与调试缓存我把整段运行流程分成五个状态INIT、HFI_INIT、HFI_CLOSE、SWITCH、SMO_CLOSE。INIT负责外设配置和参数加载HFI_INIT完成初始位置辨识和极性校验HFI_CLOSE进入低速闭环SWITCH执行权重切换SMO_CLOSE切到纯滑模观测器闭环。状态机切换条件里不仅有转速还包含电流状态有效性和过流保护标志防止观测器异常时状态机仍然强行运行。调试缓存是一个很实用的小技巧。我在RAM里开了一块环形缓冲区把估算角度、位置误差、权重系数、三相电流、滑模控制量等十几个关键量按中断周期连续记录通过调试器离线拉出来看。很多“偶发抖动”类问题实时波形根本看不清拉一段缓存做离线回放后根因很快就会浮出来。这个习惯帮我省掉了大量盲调时间。6. 常见问题与排查技巧实录6.1 高频注入时电流发散怎么办高频注入阶段如果看到电流在几毫秒内迅速增大通常是注入电压幅值过大和注入频率过高叠加导致的。处理顺序是先降低注入幅值再检查PLL解调方向是否反了。位置误差极性一旦反了闭环就变成正反馈电流自然发散。检查方法很简单把PLL输出角度与电机实际角度对比如果差接近90度且随注入时间发散基本就是极性问题。若是采样毛刺引起的发散问题往往不在参数而在ADC触发点。把触发点移回PWM中心并严格对齐两个半周期的采样点发散情况会明显改善。我在这版上曾经因为ADC触发沿配置错误把应该在中心点触发的事件改到了边沿结果高频注入电流纹波大得吓人排查一整天最后才发现是触发源配置问题。6.2 切换点附近转速波动或过流切换段出现转速波动先检查权重切换窗口是否过窄。窗口太窄会导致SMO尚未稳定就完全接管角度抖动被速度环放大。另一个高频原因是没有做角度周期归一化处理θ_HFI和θ_SMO跨0/360度边界时插值跳变切换点附近转速会出现周期性毛刺。把角度差值补偿到同一周期后再融合问题基本能解决。过流则通常出现在切换窗口后半段。我调试时发现速度环输出的转矩指令在切换段变化太快电流环来不及跟踪就触发了过流保护。解决办法是对切换段转矩指令做变化率限制同时把滑模增益k按转速线性缩放到正常值尽量避免角度融合和增益变化同时发生。6.3 SMO高速段角度滞后和抖动SMO高速段角度滞后首先怀疑低通滤波器的相位补偿没跟上转速。尤其在高倍额定转速运行时反电动势频率高滤波器相位滞后成比例增加如果查表补偿值是恒定值角度就会一直滞后。把补偿表改成按转速线性插值滞后基本可以消除。角度抖动则大概率来自滑模增益k过高。k大了以后符号函数切换的高频分量会透过低通滤波器锁相环输出跟着抖。看电流波形的话如果电流包络有明显高频毛刺先把k往小调同时把饱和函数过渡带δ稍微加大一点通常就能压下来。6.4 初始位置辨识结果相差180度这是磁极判断失效的典型症状。粗辨识得到的轴线是对的但N/S极性判断受电流采样偏差、死区补偿偏差影响在临界工况下会判反。解决方法增加多组脉冲投票机制连续三次结果取多数采样时刻延迟到脉冲稳定后不要在边沿立即采样如果还是偶尔出现在辨识完成后做一次微小步进试探对比实测电流响应方向和预期方向不匹配就重新辨识。低速带载工况下这一步可靠性直接决定系统能不能起得来。6.5 问题速查表现象直接原因处理优先级HFI电流发散注入幅值过大 / PLL极性反先查极性再降幅值切换段转速波动切换窗口过窄 / 角度跨周期跳变先做角度归一化SMO高速抖动滑模增益k过大 / 滤波器相位滞后先降k再查相位补偿初始位置180度错误磁极判断受死区/采样影响投票加稳定采样点这套B1.1版本在样机上连续跑了四十几个小时高低温环境下反复上下电最后暴露出来的问题大多集中在低速段而不是高速段这也印证了无感FOC的难点分布。最后分享一个调试心得高频注入这类弱信号处理最忌讳在仿真里觉得已经搞定就直接烧板子看效果。我的习惯是先在板子上把开环注入波形、解调误差信号、PLL输出三个量同时抓下来确认每一级信号的信噪比都正常了再合上闭环。这个习惯帮我省掉了至少一半的莫名故障排查时间各位做无感FOC的同行可以试试。