感FOC低速困境破解：d軸方波高頻注入HFI算法原理與工程實(shí)戰(zhàn))
1. 無(wú)感FOC低速困境與HFI的破局邏輯1.1 為什么低速段成了無(wú)感FOC的“燈下黑”搞過(guò)PMSM無(wú)感FOC的兄弟都清楚一個(gè)尷尬的現(xiàn)實(shí)中高速區(qū)間反電動(dòng)勢(shì)足夠大用隆貝格觀測(cè)器或者滑模觀測(cè)器都能把轉(zhuǎn)子位置估得七七八八波形也漂亮?？梢坏┺D(zhuǎn)速掉到額定轉(zhuǎn)速的5%以下甚至直接堵轉(zhuǎn)到零速反電動(dòng)勢(shì)幅值趨近于零信噪比急劇惡化觀測(cè)器就像蒙著眼睛找路——理論上有解實(shí)際上全是噪聲。這個(gè)問(wèn)題的本質(zhì)在于反電動(dòng)勢(shì)法依賴的是轉(zhuǎn)子運(yùn)動(dòng)產(chǎn)生的感應(yīng)電壓而低速時(shí)這個(gè)電壓小到被逆變器非線性、死區(qū)效應(yīng)、電流采樣噪聲完全淹沒(méi)。你就算把觀測(cè)器帶寬拉滿也只是把噪聲放大而已。所以業(yè)內(nèi)共識(shí)是——低速段必須換一套物理機(jī)制來(lái)提取位置信息不能再指望反電動(dòng)勢(shì)了。高頻注入HFI就是在這個(gè)背景下被大規(guī)模工程化的。它的核心思想很樸素既然轉(zhuǎn)子不動(dòng)或者轉(zhuǎn)得慢那我就主動(dòng)往電機(jī)里“打”一個(gè)高頻信號(hào)利用電機(jī)本身的凸極效應(yīng)d軸和q軸電感不等來(lái)探測(cè)轉(zhuǎn)子在哪個(gè)方向。這就像你在黑暗的房間里想知道門在哪與其等光線自己出現(xiàn)不如主動(dòng)喊一聲聽(tīng)回聲——凸極效應(yīng)就是那個(gè)“回聲”的物理基礎(chǔ)。1.2 凸極效應(yīng)HFI賴以生存的物理根基PMSM按轉(zhuǎn)子結(jié)構(gòu)分兩大類表貼式SPM和內(nèi)置式IPM。表貼式的永磁體貼在轉(zhuǎn)子表面d軸和q軸電感基本相等凸極率接近1HFI基本沒(méi)法用。內(nèi)置式永磁體嵌在轉(zhuǎn)子鐵芯內(nèi)部q軸磁路經(jīng)過(guò)鐵芯d軸磁路經(jīng)過(guò)永磁體而永磁體的磁導(dǎo)率接近空氣所以Ld Lq凸極率通常在1.5到3之間。這個(gè)電感差異就是HFI的“信號(hào)源”。從數(shù)學(xué)上看電機(jī)的電壓方程在dq坐標(biāo)系下可以寫成ud Rs*id Ld*d(id)/dt - ωe*Lq*iq uq Rs*iq Lq*d(iq)/dt ωe*Ld*id ωe*ψf當(dāng)注入頻率遠(yuǎn)高于基波頻率時(shí)電阻壓降和反電動(dòng)勢(shì)項(xiàng)可以忽略方程退化為純電感模型。此時(shí)如果你在估計(jì)的d軸方向注入高頻電壓電流響應(yīng)中會(huì)包含轉(zhuǎn)子實(shí)際位置與估計(jì)位置之間夾角的信息。把這個(gè)信息解調(diào)出來(lái)就能得到位置誤差信號(hào)再通過(guò)鎖相環(huán)PLL或者龍貝格觀測(cè)器收斂到真實(shí)位置。1.3 方波注入 vs 正弦波注入為什么選方波HFI的注入波形選擇上有兩條路正弦波注入和方波注入。早期方案多用正弦波因?yàn)轭l譜干凈、解調(diào)簡(jiǎn)單。但正弦波注入有個(gè)硬傷——需要低通濾波器LPF來(lái)提取包絡(luò)而LPF會(huì)引入相位延遲壓縮控制帶寬動(dòng)態(tài)響應(yīng)變慢。你想想低速時(shí)本來(lái)就想讓電機(jī)響應(yīng)快一點(diǎn)結(jié)果LPF一加帶寬掉到幾十赫茲跟蝸牛一樣。方波注入的優(yōu)勢(shì)在于方波在頻域上是一系列奇次諧波的疊加能量集中在注入頻率附近而且不需要LPF。你可以直接用電流差分來(lái)提取位置誤差信號(hào)省掉了濾波環(huán)節(jié)帶寬可以做到幾百赫茲甚至上千赫茲。代價(jià)是電流紋波和噪聲會(huì)大一些但對(duì)低速應(yīng)用來(lái)說(shuō)這個(gè)代價(jià)完全值得。具體來(lái)說(shuō)方波注入通常在一個(gè)PWM周期內(nèi)注入正負(fù)交替的電壓脈沖然后在下一個(gè)周期采樣電流差分。由于方波頻率等于PWM頻率的一半電流差分天然就是高頻響應(yīng)基波分量在差分中被抵消掉了。這個(gè)技巧在工程上非常實(shí)用后面我會(huì)詳細(xì)展開(kāi)。注意方波注入對(duì)電流采樣時(shí)序要求極高必須保證在電壓矢量作用的中點(diǎn)采樣否則會(huì)引入嚴(yán)重的采樣誤差。這一點(diǎn)在調(diào)試時(shí)如果忽略位置估算會(huì)直接發(fā)散。2. d軸方波高頻注入的算法原理推導(dǎo)2.1 坐標(biāo)系約定與注入信號(hào)定義在推導(dǎo)之前先把坐標(biāo)系說(shuō)清楚。我們定義兩套坐標(biāo)系實(shí)際轉(zhuǎn)子坐標(biāo)系dq和估計(jì)轉(zhuǎn)子坐標(biāo)系d?q?。兩者之間的夾角為Δθ θ - θ?也就是位置估計(jì)誤差。HFI的目標(biāo)就是把這個(gè)Δθ驅(qū)動(dòng)到零。注入信號(hào)選擇在估計(jì)的d?軸方向注入方波電壓幅值為Vh頻率為PWM頻率的一半。為什么選d軸而不是q軸因?yàn)閐軸注入時(shí)電流響應(yīng)中的位置誤差信號(hào)與Δθ的正弦值成正比在Δθ接近零時(shí)線性度好適合小誤差收斂。q軸注入雖然也能用但信號(hào)形式會(huì)多一個(gè)余弦項(xiàng)解調(diào)時(shí)容易產(chǎn)生死區(qū)。注入電壓的數(shù)學(xué)表達(dá)為V_inj Vh * sign(sin(ωh*t)) 沿d?軸方向其中ωh 2π*fhfh f_pwm/2。在實(shí)際實(shí)現(xiàn)中方波就是每個(gè)PWM周期交替改變注入電壓的符號(hào)所以離散化后就是第k個(gè)周期V_inj[k] Vh * (-1)^k這個(gè)交替序列在頻域上對(duì)應(yīng)一個(gè)頻率為f_pwm/2的方波其基波分量就是我們需要的注入頻率。2.2 高頻電流響應(yīng)的推導(dǎo)過(guò)程在估計(jì)的d?q?坐標(biāo)系下高頻電壓方程可以寫成[Vd?h] [Ld?d? Ld?q? ] [d(id?h)/dt] [Vq?h] [Lq?d? Lq?q? ] [d(iq?h)/dt]其中電感矩陣是實(shí)際dq電感經(jīng)過(guò)坐標(biāo)變換后的結(jié)果。經(jīng)過(guò)推導(dǎo)這里省略中間旋轉(zhuǎn)矩陣的展開(kāi)過(guò)程可以得到Ld?d? L0 L1*cos(2Δθ) Lq?q? L0 - L1*cos(2Δθ) Ld?q? Lq?d? L1*sin(2Δθ)其中L0 (LdLq)/2是平均電感L1 (Ld-Lq)/2是半差電感。對(duì)于IPM電機(jī)Lq Ld所以L1 0。由于只在d?軸注入電壓Vq?h 0代入方程并求解電流微分d(id?h)/dt Vd?h * Lq?q? / (Ld?d?*Lq?q? - Ld?q?2) d(iq?h)/dt -Vd?h * Ld?q? / (Ld?d?*Lq?q? - Ld?q?2)分母是電感矩陣的行列式化簡(jiǎn)后為L(zhǎng)d*Lq與Δθ無(wú)關(guān)。所以d(id?h)/dt Vd?h * (L0 - L1*cos(2Δθ)) / (Ld*Lq) d(iq?h)/dt -Vd?h * L1*sin(2Δθ) / (Ld*Lq)關(guān)鍵就在第二個(gè)式子q?軸的高頻電流微分與sin(2Δθ)成正比。這就是位置誤差信號(hào)的來(lái)源。當(dāng)Δθ趨近于零時(shí)sin(2Δθ) ≈ 2Δθ信號(hào)與誤差成線性關(guān)系非常適合用PLL收斂。2.3 方波差分提取位置誤差信號(hào)上面得到的是電流微分實(shí)際系統(tǒng)中我們采樣的是電流本身。方波注入的巧妙之處在于由于注入電壓正負(fù)交替相鄰兩個(gè)PWM周期的電流差分可以近似代替微分。具體操作在第k個(gè)周期注入Vh采樣電流id?[k]和iq?[k]在第k1個(gè)周期注入-Vh采樣電流id?[k1]和iq?[k1]。那么電流差分Δiq? iq?[k1] - iq?[k] ≈ -2*Vh*Ts*L1*sin(2Δθ) / (Ld*Lq)其中Ts是PWM周期。這個(gè)差分信號(hào)直接包含了sin(2Δθ)而且基波分量在差分中被抵消因?yàn)榛娏髟谙噜徶芷谧兓苄?。這就是方波注入不需要LPF的根本原因。得到Δiq?后乘以一個(gè)增益系數(shù)并送入PLLε Kp * Δiq? ω? Kp_pll * ε Ki_pll * ∫ε dt θ? ∫ω? dtPLL的帶寬設(shè)計(jì)需要權(quán)衡帶寬太高會(huì)放大噪聲太低則收斂慢。工程上通常把PLL帶寬設(shè)在50到200Hz之間具體取決于注入頻率和電流采樣噪聲水平。2.4 參數(shù)敏感性與交叉耦合補(bǔ)償HFI有一個(gè)繞不開(kāi)的問(wèn)題它對(duì)電感參數(shù)敏感。如果Ld和Lq的標(biāo)定值與實(shí)際值偏差較大位置誤差信號(hào)會(huì)出現(xiàn)直流偏置導(dǎo)致估算位置與實(shí)際位置之間存在穩(wěn)態(tài)誤差。更麻煩的是隨著電流增大鐵芯飽和會(huì)導(dǎo)致電感變化凸極率下降HFI的信噪比惡化。交叉耦合效應(yīng)是另一個(gè)坑。當(dāng)電機(jī)帶載時(shí)q軸電流產(chǎn)生的磁通會(huì)影響d軸電感的飽和程度導(dǎo)致電感矩陣出現(xiàn)交叉項(xiàng)。這個(gè)交叉項(xiàng)在位置誤差信號(hào)中表現(xiàn)為一個(gè)與負(fù)載電流相關(guān)的干擾分量。工程上的補(bǔ)償方法是根據(jù)iq的符號(hào)和大小對(duì)位置誤差信號(hào)加一個(gè)前饋補(bǔ)償項(xiàng)。這個(gè)補(bǔ)償系數(shù)需要通過(guò)實(shí)驗(yàn)標(biāo)定通常做成一個(gè)一維查表。實(shí)操心得在標(biāo)定補(bǔ)償系數(shù)時(shí)建議在多個(gè)負(fù)載點(diǎn)下測(cè)量位置誤差然后擬合出補(bǔ)償曲線。不要只在一個(gè)負(fù)載點(diǎn)標(biāo)定否則負(fù)載變化時(shí)位置估算會(huì)漂移。3. 工程實(shí)現(xiàn)中的關(guān)鍵細(xì)節(jié)與參數(shù)整定3.1 注入頻率與幅值的選取原則注入頻率的選擇有一個(gè)硬約束必須遠(yuǎn)高于基波頻率同時(shí)遠(yuǎn)低于電流環(huán)帶寬。通常注入頻率取PWM頻率的一半比如PWM頻率10kHz注入頻率就是5kHz。這個(gè)頻率足夠高基波分量在差分中被充分抑制同時(shí)又足夠低電流環(huán)能跟得上。注入幅值的選取更微妙。幅值太小電流響應(yīng)信噪比不夠位置估算抖動(dòng)大幅值太大電流紋波和噪聲增加可能觸發(fā)過(guò)流保護(hù)還會(huì)產(chǎn)生可聽(tīng)噪聲。經(jīng)驗(yàn)公式是注入電壓幅值取母線電壓的5%到10%。比如母線電壓300V注入幅值取15V到30V。實(shí)際調(diào)試時(shí)從10%開(kāi)始往下調(diào)直到位置估算波形剛好穩(wěn)定為止。注入頻率和幅值之間還有一個(gè)耦合關(guān)系注入頻率越高同樣幅值下的電流響應(yīng)越小因?yàn)樽杩闺S頻率增加。所以如果提高注入頻率需要相應(yīng)提高注入幅值來(lái)維持信噪比。這個(gè)權(quán)衡關(guān)系可以用一個(gè)簡(jiǎn)單公式估算Ih ≈ Vh / (ωh * Ld)其中Ih是高頻電流幅值。一般希望Ih在額定電流的10%到20%之間。3.2 電流采樣時(shí)序與死區(qū)補(bǔ)償方波注入對(duì)電流采樣時(shí)序的要求可以用“苛刻”來(lái)形容。由于注入電壓在相鄰周期交替變號(hào)電流差分對(duì)采樣時(shí)刻的偏差極其敏感。如果采樣時(shí)刻偏離電壓矢量作用的中點(diǎn)差分信號(hào)中會(huì)混入基波電流的變化量導(dǎo)致位置誤差信號(hào)出現(xiàn)紋波。具體操作上建議使用PWM中心對(duì)齊模式在計(jì)數(shù)器的峰值或谷值觸發(fā)ADC采樣。對(duì)于三相電流采樣要確保采樣窗口足夠?qū)挶荛_(kāi)開(kāi)關(guān)噪聲。如果使用單電阻采樣方波注入會(huì)更加復(fù)雜因?yàn)閱坞娮璨蓸有枰谔囟ㄊ噶肯虏拍苤貥?gòu)三相電流而方波注入會(huì)打亂矢量序列。所以方波HFI通常配合三電阻或雙電阻采樣使用。死區(qū)效應(yīng)是另一個(gè)隱形殺手。逆變器的死區(qū)時(shí)間會(huì)導(dǎo)致實(shí)際輸出電壓與指令電壓之間存在偏差這個(gè)偏差在方波注入下會(huì)表現(xiàn)為位置誤差信號(hào)的直流偏置。補(bǔ)償方法是根據(jù)電流方向?qū)φ伎毡冗M(jìn)行修正補(bǔ)償量等于死區(qū)時(shí)間除以PWM周期再乘以母線電壓。這個(gè)補(bǔ)償在低速時(shí)尤其重要因?yàn)樗绤^(qū)電壓相對(duì)于注入電壓的比例更大。3.3 PLL參數(shù)整定與帶寬設(shè)計(jì)PLL是HFI的位置收斂環(huán)節(jié)它的參數(shù)整定直接決定了位置估算的動(dòng)態(tài)性能和穩(wěn)態(tài)精度。PLL本質(zhì)上是一個(gè)二階系統(tǒng)其閉環(huán)傳遞函數(shù)可以寫成標(biāo)準(zhǔn)形式H(s) (2ζωn*s ωn2) / (s2 2ζωn*s ωn2)其中ωn是自然頻率ζ是阻尼比。工程上通常取ζ 0.707臨界阻尼ωn根據(jù)需要的收斂時(shí)間確定。如果希望位置估算在100ms內(nèi)收斂ωn大約取30到50rad/s。PLL的比例增益Kp_pll和積分增益Ki_pll與ωn和ζ的關(guān)系為Kp_pll 2ζωn Ki_pll ωn2但實(shí)際調(diào)試時(shí)不能直接套公式因?yàn)槲恢谜`差信號(hào)中還有噪聲和干擾。建議先用較小的帶寬ωn 20rad/s讓系統(tǒng)穩(wěn)定收斂然后逐步提高帶寬直到位置估算出現(xiàn)明顯抖動(dòng)再回退20%作為最終值。注意PLL帶寬不能超過(guò)注入頻率的十分之一否則會(huì)把注入頻率附近的噪聲放大導(dǎo)致位置估算失穩(wěn)。比如注入頻率5kHzPLL帶寬不要超過(guò)500Hz。3.4 低速到高速的平滑切換策略HFI只在低速段有效中高速段還是要靠反電動(dòng)勢(shì)觀測(cè)器。兩者之間的切換是一個(gè)工程難點(diǎn)。如果切換時(shí)位置估算角度跳變電機(jī)會(huì)出現(xiàn)轉(zhuǎn)矩沖擊甚至失步。平滑切換的核心是在切換區(qū)間內(nèi)同時(shí)運(yùn)行HFI和觀測(cè)器然后對(duì)兩個(gè)位置估算值進(jìn)行加權(quán)融合。加權(quán)系數(shù)根據(jù)轉(zhuǎn)速線性過(guò)渡比如轉(zhuǎn)速在額定轉(zhuǎn)速的3%到8%之間時(shí)HFI權(quán)重從1線性降到0觀測(cè)器權(quán)重從0線性升到1。切換過(guò)程中要確保兩個(gè)估算器的角度在同一坐標(biāo)系下否則融合沒(méi)有意義。另一個(gè)細(xì)節(jié)是切換前要讓觀測(cè)器的狀態(tài)變量收斂到與HFI一致的值否則切換瞬間觀測(cè)器輸出會(huì)跳變。工程上的做法是在切換區(qū)間內(nèi)用HFI的估算角度去初始化觀測(cè)器的積分器狀態(tài)實(shí)現(xiàn)“軟切換”。4. 常見(jiàn)問(wèn)題排查與實(shí)戰(zhàn)避坑指南4.1 位置估算抖動(dòng)大、收斂慢的排查思路位置估算抖動(dòng)是HFI調(diào)試中最常見(jiàn)的問(wèn)題。排查時(shí)按以下順序逐項(xiàng)檢查排查項(xiàng)可能原因解決方法電流采樣噪聲ADC采樣時(shí)刻偏離中點(diǎn)或采樣窗口太窄調(diào)整采樣觸發(fā)時(shí)刻增加采樣保持時(shí)間注入幅值不足信噪比低位置誤差信號(hào)被噪聲淹沒(méi)適當(dāng)提高注入幅值但不超過(guò)母線電壓15%PLL帶寬過(guò)高放大了注入頻率附近的噪聲降低PLL帶寬增加低通濾波死區(qū)補(bǔ)償不當(dāng)位置誤差信號(hào)存在直流偏置重新標(biāo)定死區(qū)補(bǔ)償系數(shù)電感參數(shù)偏差凸極率估計(jì)錯(cuò)誤信號(hào)幅值異常重新測(cè)量Ld和Lq更新參數(shù)收斂慢通常是PLL積分增益太小或者注入頻率太低導(dǎo)致電流響應(yīng)幅值不夠。可以先示波器抓一下q軸電流差分波形如果波形幅值很小說(shuō)明注入幅值或頻率需要調(diào)整。4.2 帶載時(shí)位置誤差漂移的補(bǔ)償方法空載時(shí)位置估算很準(zhǔn)一帶載就漂移這是交叉耦合效應(yīng)在作怪。補(bǔ)償方法是在位置誤差信號(hào)中減去一個(gè)與iq成正比的補(bǔ)償項(xiàng)ε_(tái)comp ε - Kc * iq其中Kc是補(bǔ)償系數(shù)需要通過(guò)實(shí)驗(yàn)標(biāo)定。標(biāo)定步驟在多個(gè)負(fù)載點(diǎn)下運(yùn)行電機(jī)記錄位置誤差和iq然后線性擬合出Kc。注意Kc的符號(hào)與電機(jī)凸極類型有關(guān)IPM電機(jī)通常Kc為正。如果補(bǔ)償后仍有殘余誤差可能是電感飽和導(dǎo)致的凸極率變化。這時(shí)需要做電感-電流查表根據(jù)id和iq實(shí)時(shí)查表得到Ld和Lq然后更新HFI的增益系數(shù)。這個(gè)查表在高端驅(qū)動(dòng)器里很常見(jiàn)但對(duì)普通應(yīng)用來(lái)說(shuō)簡(jiǎn)單的線性補(bǔ)償已經(jīng)夠用。4.3 方波注入產(chǎn)生的可聽(tīng)噪聲怎么抑制方波注入的頻率在PWM頻率的一半通常在5kHz到10kHz之間正好在人耳最敏感的頻段。電機(jī)繞組和鐵芯在這個(gè)頻率下會(huì)產(chǎn)生明顯的嘯叫用戶體驗(yàn)很差。抑制噪聲的方法有幾種一是采用隨機(jī)注入頻率讓方波頻率在PWM頻率的一半附近隨機(jī)抖動(dòng)把窄帶噪聲變成寬帶噪聲聽(tīng)感上會(huì)好很多。二是采用正弦波注入替代方波但會(huì)犧牲帶寬。三是提高注入頻率到15kHz以上超出人耳聽(tīng)覺(jué)范圍但這要求PWM頻率至少30kHz對(duì)功率器件和控制器算力都是挑戰(zhàn)。實(shí)際產(chǎn)品中如果噪聲要求嚴(yán)格通常會(huì)選擇隨機(jī)頻率方波注入加上機(jī)械隔音措施。純算法層面很難完全消除可聽(tīng)噪聲這是HFI的固有代價(jià)。4.4 零速堵轉(zhuǎn)時(shí)的位置辨識(shí)與啟動(dòng)策略零速堵轉(zhuǎn)是HFI最擅長(zhǎng)的場(chǎng)景但啟動(dòng)瞬間仍有一個(gè)問(wèn)題初始位置未知HFI需要一定時(shí)間收斂。如果直接閉環(huán)啟動(dòng)收斂過(guò)程中電機(jī)會(huì)抖動(dòng)甚至反轉(zhuǎn)。工程上的啟動(dòng)策略是先開(kāi)環(huán)注入高頻信號(hào)等待PLL收斂通常50到100ms確認(rèn)位置估算穩(wěn)定后再切換到閉環(huán)。收斂判據(jù)是位置誤差信號(hào)的幅值小于閾值且持續(xù)多個(gè)周期。這個(gè)等待時(shí)間對(duì)用戶體驗(yàn)有影響但為了可靠性必須保留。如果應(yīng)用要求快速啟動(dòng)可以先用脈沖注入法做初始位置辨識(shí)把轉(zhuǎn)子吸引到已知位置然后再啟動(dòng)HFI。脈沖注入法是在定子繞組中施加短時(shí)電壓脈沖根據(jù)電流響應(yīng)幅值判斷轉(zhuǎn)子位置。這個(gè)方法速度快但精度有限通常作為HFI的粗定位輔助。實(shí)操心得在零速堵轉(zhuǎn)測(cè)試時(shí)建議先用示波器觀察位置誤差信號(hào)的收斂過(guò)程確認(rèn)PLL在100ms內(nèi)穩(wěn)定。如果收斂時(shí)間超過(guò)200ms檢查注入幅值是否足夠或者PLL帶寬是否太低。5. 從算法到代碼核心環(huán)節(jié)的實(shí)現(xiàn)參考5.1 注入與解調(diào)的主循環(huán)偽代碼下面給出一個(gè)簡(jiǎn)化的方波HFI主循環(huán)偽代碼展示注入、采樣、解調(diào)和PLL的完整流程。實(shí)際實(shí)現(xiàn)中需要根據(jù)具體MCU的PWM和ADC配置進(jìn)行調(diào)整。// 每個(gè)PWM周期執(zhí)行一次 void HFI_ISR(void) { static int32_t sign 1; static int32_t iq_prev 0; // 1. 注入方波電壓到d軸 int32_t vd_inj sign * VH; int32_t vq_inj 0; // 2. 坐標(biāo)變換到alpha-beta送入SVPWM // ... 省略SVPWM和PWM寄存器更新代碼 // 3. 等待電流采樣完成 // ... 省略ADC觸發(fā)和等待代碼 // 4. 讀取三相電流Clarke/Park變換到d?q? int32_t id_hat ...; int32_t iq_hat ...; // 5. 計(jì)算q軸電流差分 int32_t delta_iq iq_hat - iq_prev; iq_prev iq_hat; // 6. 根據(jù)注入符號(hào)調(diào)整差分方向 int32_t error sign * delta_iq; // 7. PLL更新 int32_t omega_hat KP_PLL * error KI_PLL * integral; integral error; theta_hat omega_hat * TS; // 8. 翻轉(zhuǎn)注入符號(hào) sign -sign; }這段代碼的關(guān)鍵點(diǎn)在于差分方向要根據(jù)注入符號(hào)調(diào)整否則位置誤差信號(hào)的符號(hào)會(huì)隨注入周期翻轉(zhuǎn)PLL無(wú)法收斂。另外積分器需要做限幅防止積分飽和導(dǎo)致位置估算失控。5.2 參數(shù)整定的實(shí)操步驟參數(shù)整定建議按以下步驟進(jìn)行每一步都要用示波器或上位機(jī)觀察波形確定注入頻率取PWM頻率的一半比如PWM 10kHz注入頻率5kHz。確定注入幅值從母線電壓的5%開(kāi)始逐步提高到位置誤差信號(hào)幅值達(dá)到電流采樣噪聲的5倍以上。整定PLL比例增益先設(shè)積分增益為零逐步提高比例增益直到位置估算開(kāi)始跟蹤轉(zhuǎn)子但仍有穩(wěn)態(tài)誤差。整定PLL積分增益逐步提高積分增益直到穩(wěn)態(tài)誤差消除但不要出現(xiàn)超調(diào)或振蕩。驗(yàn)證帶載性能在50%和100%額定負(fù)載下測(cè)試位置估算精度如果誤差超過(guò)5度加入交叉耦合補(bǔ)償。驗(yàn)證切換性能在低速到中速的切換區(qū)間內(nèi)觀察位置估算是否平滑過(guò)渡如有跳變調(diào)整切換權(quán)重曲線。5.3 代碼實(shí)現(xiàn)中的常見(jiàn)陷阱第一個(gè)陷阱是定點(diǎn)數(shù)溢出。電流差分信號(hào)在定點(diǎn)數(shù)運(yùn)算中容易溢出尤其是注入幅值較大時(shí)。建議在差分計(jì)算前先做右移或者使用32位以上的累加器。第二個(gè)陷阱是PLL積分器飽和。當(dāng)位置誤差信號(hào)出現(xiàn)較大干擾時(shí)積分器會(huì)累積到限幅值導(dǎo)致位置估算卡死。解決方法是對(duì)積分器做抗飽和處理當(dāng)輸出達(dá)到限幅時(shí)停止積分。第三個(gè)陷阱是坐標(biāo)變換角度錯(cuò)誤。HFI中使用的角度是估計(jì)角度θ?而不是實(shí)際角度。如果誤用了實(shí)際角度位置誤差信號(hào)會(huì)恒為零PLL無(wú)法收斂。這個(gè)錯(cuò)誤在調(diào)試時(shí)不容易發(fā)現(xiàn)因?yàn)椴ㄐ慰雌饋?lái)“很正?！钡姍C(jī)就是轉(zhuǎn)不起來(lái)。注意在調(diào)試HFI時(shí)建議先用開(kāi)環(huán)方式注入手動(dòng)旋轉(zhuǎn)轉(zhuǎn)子觀察位置誤差信號(hào)是否隨轉(zhuǎn)子角度變化。如果信號(hào)不變說(shuō)明坐標(biāo)變換或解調(diào)環(huán)節(jié)有問(wèn)題。6. 性能邊界與適用場(chǎng)景的理性評(píng)估6.1 HFI的精度極限在哪里HFI的位置估算精度受限于幾個(gè)因素電流采樣分辨率、注入頻率與基波頻率的比值、電感參數(shù)的準(zhǔn)確性。在理想條件下HFI可以做到±1度以內(nèi)的位置精度。但實(shí)際系統(tǒng)中電流采樣噪聲、死區(qū)效應(yīng)、電感飽和等因素會(huì)把精度拉到±3到±5度。這個(gè)精度對(duì)于大多數(shù)低速應(yīng)用已經(jīng)足夠比如電動(dòng)工具的啟動(dòng)、壓縮機(jī)的低速運(yùn)行、電動(dòng)車的蠕行模式。但如果應(yīng)用要求位置精度在±1度以內(nèi)比如高精度伺服HFI可能不夠用需要配合編碼器或者更高階的觀測(cè)器。6.2 什么場(chǎng)景適合用HFI什么場(chǎng)景不適合HFI適合的場(chǎng)景內(nèi)置式PMSM、低速或零速運(yùn)行、對(duì)成本敏感不需要編碼器、對(duì)噪聲容忍度較高。典型應(yīng)用包括家電電機(jī)、電動(dòng)工具、低速電動(dòng)車、泵類負(fù)載。HFI不適合的場(chǎng)景表貼式PMSM凸極率太低、高速運(yùn)行反電動(dòng)勢(shì)法更合適、對(duì)噪聲要求極高方波注入有嘯叫、對(duì)位置精度要求極高HFI精度有限。另外如果電機(jī)電感隨電流變化劇烈HFI的標(biāo)定工作量會(huì)很大需要權(quán)衡開(kāi)發(fā)成本。6.3 與其他低速位置估算方法的對(duì)比除了HFI低速位置估算還有幾種方法脈沖注入法、旋轉(zhuǎn)高頻注入法、INFORM法。脈沖注入法速度快但精度低適合初始位置辨識(shí)。旋轉(zhuǎn)高頻注入法精度高但需要LPF帶寬受限。INFORM法利用逆變器本身的開(kāi)關(guān)狀態(tài)提取位置信息不需要額外注入但實(shí)現(xiàn)復(fù)雜且對(duì)采樣時(shí)序要求極高。方波HFI在帶寬和實(shí)現(xiàn)復(fù)雜度之間取得了較好的平衡是目前工程上最主流的選擇。它的缺點(diǎn)是噪聲和參數(shù)敏感性但通過(guò)合理的補(bǔ)償和濾波設(shè)計(jì)可以滿足大多數(shù)應(yīng)用需求。方法精度帶寬噪聲實(shí)現(xiàn)復(fù)雜度適用場(chǎng)景方波HFI±3-5度高中中低速通用旋轉(zhuǎn)HFI±2-3度低低中低速高精度脈沖注入±10-15度低高低初始位置辨識(shí)INFORM±3-5度中低高低速低噪聲7. 調(diào)試工具與實(shí)驗(yàn)平臺(tái)搭建建議7.1 硬件平臺(tái)的最低配置要求調(diào)試HFI對(duì)硬件平臺(tái)有一定要求。MCU需要支持中心對(duì)齊PWM和高速ADC采樣主頻建議在100MHz以上因?yàn)镠FI的計(jì)算量比普通FOC大不少。電流采樣建議用三電阻或雙電阻方案單電阻方案在方波注入下實(shí)現(xiàn)難度很大。逆變器的死區(qū)時(shí)間要盡量小建議在0.5微秒以下否則死區(qū)補(bǔ)償?shù)碾y度會(huì)增加。母線電壓采樣要準(zhǔn)確因?yàn)樽⑷敕低ǔ０茨妇€電壓的比例設(shè)定母線電壓波動(dòng)會(huì)直接影響注入幅值。7.2 上位機(jī)觀測(cè)工具的使用技巧調(diào)試HFI時(shí)上位機(jī)觀測(cè)工具是必不可少的。建議同時(shí)觀測(cè)以下變量估計(jì)角度θ?、實(shí)際角度如果有編碼器、位置誤差信號(hào)ε、q軸電流差分Δiq?、PLL輸出ω?。把這些變量同時(shí)顯示在示波器上可以快速定位問(wèn)題。如果位置誤差信號(hào)波形雜亂先檢查電流采樣是否干凈?？梢园央娏鞑蓸又抵苯由蟼鞯缴衔粰C(jī)觀察是否有周期性干擾。如果干擾頻率與PWM頻率相關(guān)說(shuō)明采樣時(shí)序有問(wèn)題如果與注入頻率相關(guān)說(shuō)明解調(diào)環(huán)節(jié)有問(wèn)題。7.3 從實(shí)驗(yàn)臺(tái)到產(chǎn)品的移植注意事項(xiàng)實(shí)驗(yàn)臺(tái)上跑通的HFI代碼移植到產(chǎn)品上往往會(huì)遇到新問(wèn)題。第一個(gè)問(wèn)題是電機(jī)參數(shù)不一致實(shí)驗(yàn)臺(tái)上的電機(jī)和產(chǎn)品電機(jī)可能來(lái)自不同批次電感差異會(huì)導(dǎo)致位置估算精度下降。解決方法是在產(chǎn)品上重新標(biāo)定電感參數(shù)和補(bǔ)償系數(shù)。第二個(gè)問(wèn)題是工作環(huán)境變化比如溫度變化導(dǎo)致永磁體磁通和電感變化進(jìn)而影響HFI性能。高端產(chǎn)品會(huì)做溫度補(bǔ)償根據(jù)溫度查表調(diào)整注入幅值和PLL增益。普通產(chǎn)品至少要在高低溫下驗(yàn)證HFI的穩(wěn)定性確保不會(huì)出現(xiàn)失步。第三個(gè)問(wèn)題是EMC干擾產(chǎn)品上的功率器件開(kāi)關(guān)噪聲可能耦合到電流采樣通道導(dǎo)致位置估算抖動(dòng)。解決方法包括增加采樣濾波、優(yōu)化PCB布局、使用屏蔽線等。這些措施在實(shí)驗(yàn)臺(tái)上往往被忽略但在產(chǎn)品上必須考慮。我個(gè)人在實(shí)際操作中的體會(huì)是HFI的調(diào)試過(guò)程很像調(diào)音參數(shù)之間相互耦合沒(méi)有一套放之四海而皆準(zhǔn)的配置。同樣的代碼在不同電機(jī)上表現(xiàn)可能完全不同必須根據(jù)具體電機(jī)和負(fù)載特性做針對(duì)性整定。最耗時(shí)的往往不是算法本身而是排查采樣噪聲、死區(qū)補(bǔ)償、參數(shù)偏差這些“非算法”問(wèn)題。建議在項(xiàng)目初期就預(yù)留足夠的調(diào)試時(shí)間不要低估HFI的工程化難度。 無(wú)感FOC低速困境破解：d軸方波高頻注入HFI算法原理與工程實(shí)戰(zhàn)
1. 無(wú)感FOC低速困境與HFI的破局邏輯1.1 為什么低速段成了無(wú)感FOC的“燈下黑”搞過(guò)PMSM無(wú)感FOC的兄弟都清楚一個(gè)尷尬的現(xiàn)實(shí)中高速區(qū)間反電動(dòng)勢(shì)足夠大用隆貝格觀測(cè)器或者滑模觀測(cè)器都能把轉(zhuǎn)子位置估得七七八八波形也漂亮?？梢坏┺D(zhuǎn)速掉到額定轉(zhuǎn)速的5%以下甚至直接堵轉(zhuǎn)到零速反電動(dòng)勢(shì)幅值趨近于零信噪比急劇惡化觀測(cè)器就像蒙著眼睛找路——理論上有解實(shí)際上全是噪聲。這個(gè)問(wèn)題的本質(zhì)在于反電動(dòng)勢(shì)法依賴的是轉(zhuǎn)子運(yùn)動(dòng)產(chǎn)生的感應(yīng)電壓而低速時(shí)這個(gè)電壓小到被逆變器非線性、死區(qū)效應(yīng)、電流采樣噪聲完全淹沒(méi)。你就算把觀測(cè)器帶寬拉滿也只是把噪聲放大而已。所以業(yè)內(nèi)共識(shí)是——低速段必須換一套物理機(jī)制來(lái)提取位置信息不能再指望反電動(dòng)勢(shì)了。高頻注入HFI就是在這個(gè)背景下被大規(guī)模工程化的。它的核心思想很樸素既然轉(zhuǎn)子不動(dòng)或者轉(zhuǎn)得慢那我就主動(dòng)往電機(jī)里“打”一個(gè)高頻信號(hào)利用電機(jī)本身的凸極效應(yīng)d軸和q軸電感不等來(lái)探測(cè)轉(zhuǎn)子在哪個(gè)方向。這就像你在黑暗的房間里想知道門在哪與其等光線自己出現(xiàn)不如主動(dòng)喊一聲聽(tīng)回聲——凸極效應(yīng)就是那個(gè)“回聲”的物理基礎(chǔ)。1.2 凸極效應(yīng)HFI賴以生存的物理根基PMSM按轉(zhuǎn)子結(jié)構(gòu)分兩大類表貼式SPM和內(nèi)置式IPM。表貼式的永磁體貼在轉(zhuǎn)子表面d軸和q軸電感基本相等凸極率接近1HFI基本沒(méi)法用。內(nèi)置式永磁體嵌在轉(zhuǎn)子鐵芯內(nèi)部q軸磁路經(jīng)過(guò)鐵芯d軸磁路經(jīng)過(guò)永磁體而永磁體的磁導(dǎo)率接近空氣所以Ld Lq凸極率通常在1.5到3之間。這個(gè)電感差異就是HFI的“信號(hào)源”。從數(shù)學(xué)上看電機(jī)的電壓方程在dq坐標(biāo)系下可以寫成ud Rs*id Ld*d(id)/dt - ωe*Lq*iq uq Rs*iq Lq*d(iq)/dt ωe*Ld*id ωe*ψf當(dāng)注入頻率遠(yuǎn)高于基波頻率時(shí)電阻壓降和反電動(dòng)勢(shì)項(xiàng)可以忽略方程退化為純電感模型。此時(shí)如果你在估計(jì)的d軸方向注入高頻電壓電流響應(yīng)中會(huì)包含轉(zhuǎn)子實(shí)際位置與估計(jì)位置之間夾角的信息。把這個(gè)信息解調(diào)出來(lái)就能得到位置誤差信號(hào)再通過(guò)鎖相環(huán)PLL或者龍貝格觀測(cè)器收斂到真實(shí)位置。1.3 方波注入 vs 正弦波注入為什么選方波HFI的注入波形選擇上有兩條路正弦波注入和方波注入。早期方案多用正弦波因?yàn)轭l譜干凈、解調(diào)簡(jiǎn)單。但正弦波注入有個(gè)硬傷——需要低通濾波器LPF來(lái)提取包絡(luò)而LPF會(huì)引入相位延遲壓縮控制帶寬動(dòng)態(tài)響應(yīng)變慢。你想想低速時(shí)本來(lái)就想讓電機(jī)響應(yīng)快一點(diǎn)結(jié)果LPF一加帶寬掉到幾十赫茲跟蝸牛一樣。方波注入的優(yōu)勢(shì)在于方波在頻域上是一系列奇次諧波的疊加能量集中在注入頻率附近而且不需要LPF。你可以直接用電流差分來(lái)提取位置誤差信號(hào)省掉了濾波環(huán)節(jié)帶寬可以做到幾百赫茲甚至上千赫茲。代價(jià)是電流紋波和噪聲會(huì)大一些但對(duì)低速應(yīng)用來(lái)說(shuō)這個(gè)代價(jià)完全值得。具體來(lái)說(shuō)方波注入通常在一個(gè)PWM周期內(nèi)注入正負(fù)交替的電壓脈沖然后在下一個(gè)周期采樣電流差分。由于方波頻率等于PWM頻率的一半電流差分天然就是高頻響應(yīng)基波分量在差分中被抵消掉了。這個(gè)技巧在工程上非常實(shí)用后面我會(huì)詳細(xì)展開(kāi)。注意方波注入對(duì)電流采樣時(shí)序要求極高必須保證在電壓矢量作用的中點(diǎn)采樣否則會(huì)引入嚴(yán)重的采樣誤差。這一點(diǎn)在調(diào)試時(shí)如果忽略位置估算會(huì)直接發(fā)散。2. d軸方波高頻注入的算法原理推導(dǎo)2.1 坐標(biāo)系約定與注入信號(hào)定義在推導(dǎo)之前先把坐標(biāo)系說(shuō)清楚。我們定義兩套坐標(biāo)系實(shí)際轉(zhuǎn)子坐標(biāo)系dq和估計(jì)轉(zhuǎn)子坐標(biāo)系d?q?。兩者之間的夾角為Δθ θ - θ?也就是位置估計(jì)誤差。HFI的目標(biāo)就是把這個(gè)Δθ驅(qū)動(dòng)到零。注入信號(hào)選擇在估計(jì)的d?軸方向注入方波電壓幅值為Vh頻率為PWM頻率的一半。為什么選d軸而不是q軸因?yàn)閐軸注入時(shí)電流響應(yīng)中的位置誤差信號(hào)與Δθ的正弦值成正比在Δθ接近零時(shí)線性度好適合小誤差收斂。q軸注入雖然也能用但信號(hào)形式會(huì)多一個(gè)余弦項(xiàng)解調(diào)時(shí)容易產(chǎn)生死區(qū)。注入電壓的數(shù)學(xué)表達(dá)為V_inj Vh * sign(sin(ωh*t)) 沿d?軸方向其中ωh 2π*fhfh f_pwm/2。在實(shí)際實(shí)現(xiàn)中方波就是每個(gè)PWM周期交替改變注入電壓的符號(hào)所以離散化后就是第k個(gè)周期V_inj[k] Vh * (-1)^k這個(gè)交替序列在頻域上對(duì)應(yīng)一個(gè)頻率為f_pwm/2的方波其基波分量就是我們需要的注入頻率。2.2 高頻電流響應(yīng)的推導(dǎo)過(guò)程在估計(jì)的d?q?坐標(biāo)系下高頻電壓方程可以寫成[Vd?h] [Ld?d? Ld?q? ] [d(id?h)/dt] [Vq?h] [Lq?d? Lq?q? ] [d(iq?h)/dt]其中電感矩陣是實(shí)際dq電感經(jīng)過(guò)坐標(biāo)變換后的結(jié)果。經(jīng)過(guò)推導(dǎo)這里省略中間旋轉(zhuǎn)矩陣的展開(kāi)過(guò)程可以得到Ld?d? L0 L1*cos(2Δθ) Lq?q? L0 - L1*cos(2Δθ) Ld?q? Lq?d? L1*sin(2Δθ)其中L0 (LdLq)/2是平均電感L1 (Ld-Lq)/2是半差電感。對(duì)于IPM電機(jī)Lq Ld所以L1 0。由于只在d?軸注入電壓Vq?h 0代入方程并求解電流微分d(id?h)/dt Vd?h * Lq?q? / (Ld?d?*Lq?q? - Ld?q?2) d(iq?h)/dt -Vd?h * Ld?q? / (Ld?d?*Lq?q? - Ld?q?2)分母是電感矩陣的行列式化簡(jiǎn)后為L(zhǎng)d*Lq與Δθ無(wú)關(guān)。所以d(id?h)/dt Vd?h * (L0 - L1*cos(2Δθ)) / (Ld*Lq) d(iq?h)/dt -Vd?h * L1*sin(2Δθ) / (Ld*Lq)關(guān)鍵就在第二個(gè)式子q?軸的高頻電流微分與sin(2Δθ)成正比。這就是位置誤差信號(hào)的來(lái)源。當(dāng)Δθ趨近于零時(shí)sin(2Δθ) ≈ 2Δθ信號(hào)與誤差成線性關(guān)系非常適合用PLL收斂。2.3 方波差分提取位置誤差信號(hào)上面得到的是電流微分實(shí)際系統(tǒng)中我們采樣的是電流本身。方波注入的巧妙之處在于由于注入電壓正負(fù)交替相鄰兩個(gè)PWM周期的電流差分可以近似代替微分。具體操作在第k個(gè)周期注入Vh采樣電流id?[k]和iq?[k]在第k1個(gè)周期注入-Vh采樣電流id?[k1]和iq?[k1]。那么電流差分Δiq? iq?[k1] - iq?[k] ≈ -2*Vh*Ts*L1*sin(2Δθ) / (Ld*Lq)其中Ts是PWM周期。這個(gè)差分信號(hào)直接包含了sin(2Δθ)而且基波分量在差分中被抵消因?yàn)榛娏髟谙噜徶芷谧兓苄?。這就是方波注入不需要LPF的根本原因。得到Δiq?后乘以一個(gè)增益系數(shù)并送入PLLε Kp * Δiq? ω? Kp_pll * ε Ki_pll * ∫ε dt θ? ∫ω? dtPLL的帶寬設(shè)計(jì)需要權(quán)衡帶寬太高會(huì)放大噪聲太低則收斂慢。工程上通常把PLL帶寬設(shè)在50到200Hz之間具體取決于注入頻率和電流采樣噪聲水平。2.4 參數(shù)敏感性與交叉耦合補(bǔ)償HFI有一個(gè)繞不開(kāi)的問(wèn)題它對(duì)電感參數(shù)敏感。如果Ld和Lq的標(biāo)定值與實(shí)際值偏差較大位置誤差信號(hào)會(huì)出現(xiàn)直流偏置導(dǎo)致估算位置與實(shí)際位置之間存在穩(wěn)態(tài)誤差。更麻煩的是隨著電流增大鐵芯飽和會(huì)導(dǎo)致電感變化凸極率下降HFI的信噪比惡化。交叉耦合效應(yīng)是另一個(gè)坑。當(dāng)電機(jī)帶載時(shí)q軸電流產(chǎn)生的磁通會(huì)影響d軸電感的飽和程度導(dǎo)致電感矩陣出現(xiàn)交叉項(xiàng)。這個(gè)交叉項(xiàng)在位置誤差信號(hào)中表現(xiàn)為一個(gè)與負(fù)載電流相關(guān)的干擾分量。工程上的補(bǔ)償方法是根據(jù)iq的符號(hào)和大小對(duì)位置誤差信號(hào)加一個(gè)前饋補(bǔ)償項(xiàng)。這個(gè)補(bǔ)償系數(shù)需要通過(guò)實(shí)驗(yàn)標(biāo)定通常做成一個(gè)一維查表。實(shí)操心得在標(biāo)定補(bǔ)償系數(shù)時(shí)建議在多個(gè)負(fù)載點(diǎn)下測(cè)量位置誤差然后擬合出補(bǔ)償曲線。不要只在一個(gè)負(fù)載點(diǎn)標(biāo)定否則負(fù)載變化時(shí)位置估算會(huì)漂移。3. 工程實(shí)現(xiàn)中的關(guān)鍵細(xì)節(jié)與參數(shù)整定3.1 注入頻率與幅值的選取原則注入頻率的選擇有一個(gè)硬約束必須遠(yuǎn)高于基波頻率同時(shí)遠(yuǎn)低于電流環(huán)帶寬。通常注入頻率取PWM頻率的一半比如PWM頻率10kHz注入頻率就是5kHz。這個(gè)頻率足夠高基波分量在差分中被充分抑制同時(shí)又足夠低電流環(huán)能跟得上。注入幅值的選取更微妙。幅值太小電流響應(yīng)信噪比不夠位置估算抖動(dòng)大幅值太大電流紋波和噪聲增加可能觸發(fā)過(guò)流保護(hù)還會(huì)產(chǎn)生可聽(tīng)噪聲。經(jīng)驗(yàn)公式是注入電壓幅值取母線電壓的5%到10%。比如母線電壓300V注入幅值取15V到30V。實(shí)際調(diào)試時(shí)從10%開(kāi)始往下調(diào)直到位置估算波形剛好穩(wěn)定為止。注入頻率和幅值之間還有一個(gè)耦合關(guān)系注入頻率越高同樣幅值下的電流響應(yīng)越小因?yàn)樽杩闺S頻率增加。所以如果提高注入頻率需要相應(yīng)提高注入幅值來(lái)維持信噪比。這個(gè)權(quán)衡關(guān)系可以用一個(gè)簡(jiǎn)單公式估算Ih ≈ Vh / (ωh * Ld)其中Ih是高頻電流幅值。一般希望Ih在額定電流的10%到20%之間。3.2 電流采樣時(shí)序與死區(qū)補(bǔ)償方波注入對(duì)電流采樣時(shí)序的要求可以用“苛刻”來(lái)形容。由于注入電壓在相鄰周期交替變號(hào)電流差分對(duì)采樣時(shí)刻的偏差極其敏感。如果采樣時(shí)刻偏離電壓矢量作用的中點(diǎn)差分信號(hào)中會(huì)混入基波電流的變化量導(dǎo)致位置誤差信號(hào)出現(xiàn)紋波。具體操作上建議使用PWM中心對(duì)齊模式在計(jì)數(shù)器的峰值或谷值觸發(fā)ADC采樣。對(duì)于三相電流采樣要確保采樣窗口足夠?qū)挶荛_(kāi)開(kāi)關(guān)噪聲。如果使用單電阻采樣方波注入會(huì)更加復(fù)雜因?yàn)閱坞娮璨蓸有枰谔囟ㄊ噶肯虏拍苤貥?gòu)三相電流而方波注入會(huì)打亂矢量序列。所以方波HFI通常配合三電阻或雙電阻采樣使用。死區(qū)效應(yīng)是另一個(gè)隱形殺手。逆變器的死區(qū)時(shí)間會(huì)導(dǎo)致實(shí)際輸出電壓與指令電壓之間存在偏差這個(gè)偏差在方波注入下會(huì)表現(xiàn)為位置誤差信號(hào)的直流偏置。補(bǔ)償方法是根據(jù)電流方向?qū)φ伎毡冗M(jìn)行修正補(bǔ)償量等于死區(qū)時(shí)間除以PWM周期再乘以母線電壓。這個(gè)補(bǔ)償在低速時(shí)尤其重要因?yàn)樗绤^(qū)電壓相對(duì)于注入電壓的比例更大。3.3 PLL參數(shù)整定與帶寬設(shè)計(jì)PLL是HFI的位置收斂環(huán)節(jié)它的參數(shù)整定直接決定了位置估算的動(dòng)態(tài)性能和穩(wěn)態(tài)精度。PLL本質(zhì)上是一個(gè)二階系統(tǒng)其閉環(huán)傳遞函數(shù)可以寫成標(biāo)準(zhǔn)形式H(s) (2ζωn*s ωn2) / (s2 2ζωn*s ωn2)其中ωn是自然頻率ζ是阻尼比。工程上通常取ζ 0.707臨界阻尼ωn根據(jù)需要的收斂時(shí)間確定。如果希望位置估算在100ms內(nèi)收斂ωn大約取30到50rad/s。PLL的比例增益Kp_pll和積分增益Ki_pll與ωn和ζ的關(guān)系為Kp_pll 2ζωn Ki_pll ωn2但實(shí)際調(diào)試時(shí)不能直接套公式因?yàn)槲恢谜`差信號(hào)中還有噪聲和干擾。建議先用較小的帶寬ωn 20rad/s讓系統(tǒng)穩(wěn)定收斂然后逐步提高帶寬直到位置估算出現(xiàn)明顯抖動(dòng)再回退20%作為最終值。注意PLL帶寬不能超過(guò)注入頻率的十分之一否則會(huì)把注入頻率附近的噪聲放大導(dǎo)致位置估算失穩(wěn)。比如注入頻率5kHzPLL帶寬不要超過(guò)500Hz。3.4 低速到高速的平滑切換策略HFI只在低速段有效中高速段還是要靠反電動(dòng)勢(shì)觀測(cè)器。兩者之間的切換是一個(gè)工程難點(diǎn)。如果切換時(shí)位置估算角度跳變電機(jī)會(huì)出現(xiàn)轉(zhuǎn)矩沖擊甚至失步。平滑切換的核心是在切換區(qū)間內(nèi)同時(shí)運(yùn)行HFI和觀測(cè)器然后對(duì)兩個(gè)位置估算值進(jìn)行加權(quán)融合。加權(quán)系數(shù)根據(jù)轉(zhuǎn)速線性過(guò)渡比如轉(zhuǎn)速在額定轉(zhuǎn)速的3%到8%之間時(shí)HFI權(quán)重從1線性降到0觀測(cè)器權(quán)重從0線性升到1。切換過(guò)程中要確保兩個(gè)估算器的角度在同一坐標(biāo)系下否則融合沒(méi)有意義。另一個(gè)細(xì)節(jié)是切換前要讓觀測(cè)器的狀態(tài)變量收斂到與HFI一致的值否則切換瞬間觀測(cè)器輸出會(huì)跳變。工程上的做法是在切換區(qū)間內(nèi)用HFI的估算角度去初始化觀測(cè)器的積分器狀態(tài)實(shí)現(xiàn)“軟切換”。4. 常見(jiàn)問(wèn)題排查與實(shí)戰(zhàn)避坑指南4.1 位置估算抖動(dòng)大、收斂慢的排查思路位置估算抖動(dòng)是HFI調(diào)試中最常見(jiàn)的問(wèn)題。排查時(shí)按以下順序逐項(xiàng)檢查排查項(xiàng)可能原因解決方法電流采樣噪聲ADC采樣時(shí)刻偏離中點(diǎn)或采樣窗口太窄調(diào)整采樣觸發(fā)時(shí)刻增加采樣保持時(shí)間注入幅值不足信噪比低位置誤差信號(hào)被噪聲淹沒(méi)適當(dāng)提高注入幅值但不超過(guò)母線電壓15%PLL帶寬過(guò)高放大了注入頻率附近的噪聲降低PLL帶寬增加低通濾波死區(qū)補(bǔ)償不當(dāng)位置誤差信號(hào)存在直流偏置重新標(biāo)定死區(qū)補(bǔ)償系數(shù)電感參數(shù)偏差凸極率估計(jì)錯(cuò)誤信號(hào)幅值異常重新測(cè)量Ld和Lq更新參數(shù)收斂慢通常是PLL積分增益太小或者注入頻率太低導(dǎo)致電流響應(yīng)幅值不夠。可以先示波器抓一下q軸電流差分波形如果波形幅值很小說(shuō)明注入幅值或頻率需要調(diào)整。4.2 帶載時(shí)位置誤差漂移的補(bǔ)償方法空載時(shí)位置估算很準(zhǔn)一帶載就漂移這是交叉耦合效應(yīng)在作怪。補(bǔ)償方法是在位置誤差信號(hào)中減去一個(gè)與iq成正比的補(bǔ)償項(xiàng)ε_(tái)comp ε - Kc * iq其中Kc是補(bǔ)償系數(shù)需要通過(guò)實(shí)驗(yàn)標(biāo)定。標(biāo)定步驟在多個(gè)負(fù)載點(diǎn)下運(yùn)行電機(jī)記錄位置誤差和iq然后線性擬合出Kc。注意Kc的符號(hào)與電機(jī)凸極類型有關(guān)IPM電機(jī)通常Kc為正。如果補(bǔ)償后仍有殘余誤差可能是電感飽和導(dǎo)致的凸極率變化。這時(shí)需要做電感-電流查表根據(jù)id和iq實(shí)時(shí)查表得到Ld和Lq然后更新HFI的增益系數(shù)。這個(gè)查表在高端驅(qū)動(dòng)器里很常見(jiàn)但對(duì)普通應(yīng)用來(lái)說(shuō)簡(jiǎn)單的線性補(bǔ)償已經(jīng)夠用。4.3 方波注入產(chǎn)生的可聽(tīng)噪聲怎么抑制方波注入的頻率在PWM頻率的一半通常在5kHz到10kHz之間正好在人耳最敏感的頻段。電機(jī)繞組和鐵芯在這個(gè)頻率下會(huì)產(chǎn)生明顯的嘯叫用戶體驗(yàn)很差。抑制噪聲的方法有幾種一是采用隨機(jī)注入頻率讓方波頻率在PWM頻率的一半附近隨機(jī)抖動(dòng)把窄帶噪聲變成寬帶噪聲聽(tīng)感上會(huì)好很多。二是采用正弦波注入替代方波但會(huì)犧牲帶寬。三是提高注入頻率到15kHz以上超出人耳聽(tīng)覺(jué)范圍但這要求PWM頻率至少30kHz對(duì)功率器件和控制器算力都是挑戰(zhàn)。實(shí)際產(chǎn)品中如果噪聲要求嚴(yán)格通常會(huì)選擇隨機(jī)頻率方波注入加上機(jī)械隔音措施。純算法層面很難完全消除可聽(tīng)噪聲這是HFI的固有代價(jià)。4.4 零速堵轉(zhuǎn)時(shí)的位置辨識(shí)與啟動(dòng)策略零速堵轉(zhuǎn)是HFI最擅長(zhǎng)的場(chǎng)景但啟動(dòng)瞬間仍有一個(gè)問(wèn)題初始位置未知HFI需要一定時(shí)間收斂。如果直接閉環(huán)啟動(dòng)收斂過(guò)程中電機(jī)會(huì)抖動(dòng)甚至反轉(zhuǎn)。工程上的啟動(dòng)策略是先開(kāi)環(huán)注入高頻信號(hào)等待PLL收斂通常50到100ms確認(rèn)位置估算穩(wěn)定后再切換到閉環(huán)。收斂判據(jù)是位置誤差信號(hào)的幅值小于閾值且持續(xù)多個(gè)周期。這個(gè)等待時(shí)間對(duì)用戶體驗(yàn)有影響但為了可靠性必須保留。如果應(yīng)用要求快速啟動(dòng)可以先用脈沖注入法做初始位置辨識(shí)把轉(zhuǎn)子吸引到已知位置然后再啟動(dòng)HFI。脈沖注入法是在定子繞組中施加短時(shí)電壓脈沖根據(jù)電流響應(yīng)幅值判斷轉(zhuǎn)子位置。這個(gè)方法速度快但精度有限通常作為HFI的粗定位輔助。實(shí)操心得在零速堵轉(zhuǎn)測(cè)試時(shí)建議先用示波器觀察位置誤差信號(hào)的收斂過(guò)程確認(rèn)PLL在100ms內(nèi)穩(wěn)定。如果收斂時(shí)間超過(guò)200ms檢查注入幅值是否足夠或者PLL帶寬是否太低。5. 從算法到代碼核心環(huán)節(jié)的實(shí)現(xiàn)參考5.1 注入與解調(diào)的主循環(huán)偽代碼下面給出一個(gè)簡(jiǎn)化的方波HFI主循環(huán)偽代碼展示注入、采樣、解調(diào)和PLL的完整流程。實(shí)際實(shí)現(xiàn)中需要根據(jù)具體MCU的PWM和ADC配置進(jìn)行調(diào)整。// 每個(gè)PWM周期執(zhí)行一次 void HFI_ISR(void) { static int32_t sign 1; static int32_t iq_prev 0; // 1. 注入方波電壓到d軸 int32_t vd_inj sign * VH; int32_t vq_inj 0; // 2. 坐標(biāo)變換到alpha-beta送入SVPWM // ... 省略SVPWM和PWM寄存器更新代碼 // 3. 等待電流采樣完成 // ... 省略ADC觸發(fā)和等待代碼 // 4. 讀取三相電流Clarke/Park變換到d?q? int32_t id_hat ...; int32_t iq_hat ...; // 5. 計(jì)算q軸電流差分 int32_t delta_iq iq_hat - iq_prev; iq_prev iq_hat; // 6. 根據(jù)注入符號(hào)調(diào)整差分方向 int32_t error sign * delta_iq; // 7. PLL更新 int32_t omega_hat KP_PLL * error KI_PLL * integral; integral error; theta_hat omega_hat * TS; // 8. 翻轉(zhuǎn)注入符號(hào) sign -sign; }這段代碼的關(guān)鍵點(diǎn)在于差分方向要根據(jù)注入符號(hào)調(diào)整否則位置誤差信號(hào)的符號(hào)會(huì)隨注入周期翻轉(zhuǎn)PLL無(wú)法收斂。另外積分器需要做限幅防止積分飽和導(dǎo)致位置估算失控。5.2 參數(shù)整定的實(shí)操步驟參數(shù)整定建議按以下步驟進(jìn)行每一步都要用示波器或上位機(jī)觀察波形確定注入頻率取PWM頻率的一半比如PWM 10kHz注入頻率5kHz。確定注入幅值從母線電壓的5%開(kāi)始逐步提高到位置誤差信號(hào)幅值達(dá)到電流采樣噪聲的5倍以上。整定PLL比例增益先設(shè)積分增益為零逐步提高比例增益直到位置估算開(kāi)始跟蹤轉(zhuǎn)子但仍有穩(wěn)態(tài)誤差。整定PLL積分增益逐步提高積分增益直到穩(wěn)態(tài)誤差消除但不要出現(xiàn)超調(diào)或振蕩。驗(yàn)證帶載性能在50%和100%額定負(fù)載下測(cè)試位置估算精度如果誤差超過(guò)5度加入交叉耦合補(bǔ)償。驗(yàn)證切換性能在低速到中速的切換區(qū)間內(nèi)觀察位置估算是否平滑過(guò)渡如有跳變調(diào)整切換權(quán)重曲線。5.3 代碼實(shí)現(xiàn)中的常見(jiàn)陷阱第一個(gè)陷阱是定點(diǎn)數(shù)溢出。電流差分信號(hào)在定點(diǎn)數(shù)運(yùn)算中容易溢出尤其是注入幅值較大時(shí)。建議在差分計(jì)算前先做右移或者使用32位以上的累加器。第二個(gè)陷阱是PLL積分器飽和。當(dāng)位置誤差信號(hào)出現(xiàn)較大干擾時(shí)積分器會(huì)累積到限幅值導(dǎo)致位置估算卡死。解決方法是對(duì)積分器做抗飽和處理當(dāng)輸出達(dá)到限幅時(shí)停止積分。第三個(gè)陷阱是坐標(biāo)變換角度錯(cuò)誤。HFI中使用的角度是估計(jì)角度θ?而不是實(shí)際角度。如果誤用了實(shí)際角度位置誤差信號(hào)會(huì)恒為零PLL無(wú)法收斂。這個(gè)錯(cuò)誤在調(diào)試時(shí)不容易發(fā)現(xiàn)因?yàn)椴ㄐ慰雌饋?lái)“很正?！钡姍C(jī)就是轉(zhuǎn)不起來(lái)。注意在調(diào)試HFI時(shí)建議先用開(kāi)環(huán)方式注入手動(dòng)旋轉(zhuǎn)轉(zhuǎn)子觀察位置誤差信號(hào)是否隨轉(zhuǎn)子角度變化。如果信號(hào)不變說(shuō)明坐標(biāo)變換或解調(diào)環(huán)節(jié)有問(wèn)題。6. 性能邊界與適用場(chǎng)景的理性評(píng)估6.1 HFI的精度極限在哪里HFI的位置估算精度受限于幾個(gè)因素電流采樣分辨率、注入頻率與基波頻率的比值、電感參數(shù)的準(zhǔn)確性。在理想條件下HFI可以做到±1度以內(nèi)的位置精度。但實(shí)際系統(tǒng)中電流采樣噪聲、死區(qū)效應(yīng)、電感飽和等因素會(huì)把精度拉到±3到±5度。這個(gè)精度對(duì)于大多數(shù)低速應(yīng)用已經(jīng)足夠比如電動(dòng)工具的啟動(dòng)、壓縮機(jī)的低速運(yùn)行、電動(dòng)車的蠕行模式。但如果應(yīng)用要求位置精度在±1度以內(nèi)比如高精度伺服HFI可能不夠用需要配合編碼器或者更高階的觀測(cè)器。6.2 什么場(chǎng)景適合用HFI什么場(chǎng)景不適合HFI適合的場(chǎng)景內(nèi)置式PMSM、低速或零速運(yùn)行、對(duì)成本敏感不需要編碼器、對(duì)噪聲容忍度較高。典型應(yīng)用包括家電電機(jī)、電動(dòng)工具、低速電動(dòng)車、泵類負(fù)載。HFI不適合的場(chǎng)景表貼式PMSM凸極率太低、高速運(yùn)行反電動(dòng)勢(shì)法更合適、對(duì)噪聲要求極高方波注入有嘯叫、對(duì)位置精度要求極高HFI精度有限。另外如果電機(jī)電感隨電流變化劇烈HFI的標(biāo)定工作量會(huì)很大需要權(quán)衡開(kāi)發(fā)成本。6.3 與其他低速位置估算方法的對(duì)比除了HFI低速位置估算還有幾種方法脈沖注入法、旋轉(zhuǎn)高頻注入法、INFORM法。脈沖注入法速度快但精度低適合初始位置辨識(shí)。旋轉(zhuǎn)高頻注入法精度高但需要LPF帶寬受限。INFORM法利用逆變器本身的開(kāi)關(guān)狀態(tài)提取位置信息不需要額外注入但實(shí)現(xiàn)復(fù)雜且對(duì)采樣時(shí)序要求極高。方波HFI在帶寬和實(shí)現(xiàn)復(fù)雜度之間取得了較好的平衡是目前工程上最主流的選擇。它的缺點(diǎn)是噪聲和參數(shù)敏感性但通過(guò)合理的補(bǔ)償和濾波設(shè)計(jì)可以滿足大多數(shù)應(yīng)用需求。方法精度帶寬噪聲實(shí)現(xiàn)復(fù)雜度適用場(chǎng)景方波HFI±3-5度高中中低速通用旋轉(zhuǎn)HFI±2-3度低低中低速高精度脈沖注入±10-15度低高低初始位置辨識(shí)INFORM±3-5度中低高低速低噪聲7. 調(diào)試工具與實(shí)驗(yàn)平臺(tái)搭建建議7.1 硬件平臺(tái)的最低配置要求調(diào)試HFI對(duì)硬件平臺(tái)有一定要求。MCU需要支持中心對(duì)齊PWM和高速ADC采樣主頻建議在100MHz以上因?yàn)镠FI的計(jì)算量比普通FOC大不少。電流采樣建議用三電阻或雙電阻方案單電阻方案在方波注入下實(shí)現(xiàn)難度很大。逆變器的死區(qū)時(shí)間要盡量小建議在0.5微秒以下否則死區(qū)補(bǔ)償?shù)碾y度會(huì)增加。母線電壓采樣要準(zhǔn)確因?yàn)樽⑷敕低ǔ０茨妇€電壓的比例設(shè)定母線電壓波動(dòng)會(huì)直接影響注入幅值。7.2 上位機(jī)觀測(cè)工具的使用技巧調(diào)試HFI時(shí)上位機(jī)觀測(cè)工具是必不可少的。建議同時(shí)觀測(cè)以下變量估計(jì)角度θ?、實(shí)際角度如果有編碼器、位置誤差信號(hào)ε、q軸電流差分Δiq?、PLL輸出ω?。把這些變量同時(shí)顯示在示波器上可以快速定位問(wèn)題。如果位置誤差信號(hào)波形雜亂先檢查電流采樣是否干凈?？梢园央娏鞑蓸又抵苯由蟼鞯缴衔粰C(jī)觀察是否有周期性干擾。如果干擾頻率與PWM頻率相關(guān)說(shuō)明采樣時(shí)序有問(wèn)題如果與注入頻率相關(guān)說(shuō)明解調(diào)環(huán)節(jié)有問(wèn)題。7.3 從實(shí)驗(yàn)臺(tái)到產(chǎn)品的移植注意事項(xiàng)實(shí)驗(yàn)臺(tái)上跑通的HFI代碼移植到產(chǎn)品上往往會(huì)遇到新問(wèn)題。第一個(gè)問(wèn)題是電機(jī)參數(shù)不一致實(shí)驗(yàn)臺(tái)上的電機(jī)和產(chǎn)品電機(jī)可能來(lái)自不同批次電感差異會(huì)導(dǎo)致位置估算精度下降。解決方法是在產(chǎn)品上重新標(biāo)定電感參數(shù)和補(bǔ)償系數(shù)。第二個(gè)問(wèn)題是工作環(huán)境變化比如溫度變化導(dǎo)致永磁體磁通和電感變化進(jìn)而影響HFI性能。高端產(chǎn)品會(huì)做溫度補(bǔ)償根據(jù)溫度查表調(diào)整注入幅值和PLL增益。普通產(chǎn)品至少要在高低溫下驗(yàn)證HFI的穩(wěn)定性確保不會(huì)出現(xiàn)失步。第三個(gè)問(wèn)題是EMC干擾產(chǎn)品上的功率器件開(kāi)關(guān)噪聲可能耦合到電流采樣通道導(dǎo)致位置估算抖動(dòng)。解決方法包括增加采樣濾波、優(yōu)化PCB布局、使用屏蔽線等。這些措施在實(shí)驗(yàn)臺(tái)上往往被忽略但在產(chǎn)品上必須考慮。我個(gè)人在實(shí)際操作中的體會(huì)是HFI的調(diào)試過(guò)程很像調(diào)音參數(shù)之間相互耦合沒(méi)有一套放之四海而皆準(zhǔn)的配置。同樣的代碼在不同電機(jī)上表現(xiàn)可能完全不同必須根據(jù)具體電機(jī)和負(fù)載特性做針對(duì)性整定。最耗時(shí)的往往不是算法本身而是排查采樣噪聲、死區(qū)補(bǔ)償、參數(shù)偏差這些“非算法”問(wèn)題。建議在項(xiàng)目初期就預(yù)留足夠的調(diào)試時(shí)間不要低估HFI的工程化難度。