測(cè)器無(wú)位置傳感器控制及抖振優(yōu)化實(shí)現(xiàn))
做PMSM無(wú)位置傳感器控制的人幾乎都會(huì)被抖振這件事折磨過(guò)。我這次復(fù)現(xiàn)的是基于高速滑模觀(guān)測(cè)器優(yōu)化抖振問(wèn)題的永磁同步電機(jī)無(wú)位置傳感器控制算法目標(biāo)很明確把轉(zhuǎn)子位置和轉(zhuǎn)速通過(guò)算法“觀(guān)測(cè)”出來(lái)同時(shí)把滑?？刂铺焐詭У母哳l抖振在高速工況下壓下去。整套東西從原理到Matlab實(shí)現(xiàn)再到調(diào)試過(guò)程中踩過(guò)的坑我會(huì)一次講清楚。如果你正在做無(wú)感控制方向的研究或者正準(zhǔn)備復(fù)現(xiàn)一套滑模觀(guān)測(cè)器算法這篇文章應(yīng)該能幫你省下不少試錯(cuò)時(shí)間。1. 無(wú)位置傳感器控制先想清楚你真正要“觀(guān)”的其實(shí)是反電動(dòng)勢(shì)1.1 PMSM模型里的轉(zhuǎn)子位置藏在哪里無(wú)位置傳感器控制的第一步不是上來(lái)就寫(xiě)觀(guān)測(cè)器而是先搞清楚我們要觀(guān)測(cè)的物理量是什么。永磁同步電機(jī)在靜止坐標(biāo)系下的電壓方程表貼式結(jié)構(gòu)下可以寫(xiě)成u_alpha Rs * i_alpha Ls * d(i_alpha)/dt e_alpha u_beta Rs * i_beta Ls * d(i_beta)/dt e_beta這里的 e_alpha、e_beta 就是反電動(dòng)勢(shì)在靜止坐標(biāo)系下的分量它們的表達(dá)式是e_alpha -psi_f * omega_e * sin(theta_e) e_beta psi_f * omega_e * cos(theta_e)psi_f 是永磁磁鏈omega_e 是電角速度theta_e 就是轉(zhuǎn)子電角度。你可以發(fā)現(xiàn)轉(zhuǎn)子位置信息完全藏在反電動(dòng)勢(shì)里。只要能把 e_alpha 和 e_beta 估出來(lái)角度理論上就可以通過(guò)反三角函數(shù)算出來(lái)theta_e atan2(-e_alpha, e_beta)這里要提醒一句這個(gè)式子里的負(fù)號(hào)非常容易搞錯(cuò)。我第一次寫(xiě)代碼的時(shí)候直接把 atan2(e_alpha, e_beta) 拿過(guò)來(lái)用結(jié)果角度偏了 90 度電流環(huán)直接發(fā)散。先把這個(gè)關(guān)系理清后面才不會(huì)在層次上栽跟頭。1.2 滑模觀(guān)測(cè)器憑什么能把位置“逼”出來(lái)現(xiàn)在的問(wèn)題變成了如何在不知道 e_alpha、e_beta 的情況下把它們估計(jì)出來(lái)?；Ｓ^(guān)測(cè)器的思路很直接。我們把電壓方程里的電流狀態(tài)單獨(dú)拿出來(lái)d(i_alpha)/dt (u_alpha - Rs * i_alpha - e_alpha) / Ls d(i_beta)/dt (u_beta - Rs * i_beta - e_beta) / Lse_alpha 和 e_beta 在這里扮演的是“未知擾動(dòng)”的角色。我們構(gòu)造一個(gè)電流估計(jì)系統(tǒng)d(i_alpha_hat)/dt (u_alpha - Rs * i_alpha_hat - v_alpha) / Ls d(i_beta_hat)/dt (u_beta - Rs * i_beta_hat - v_beta) / Ls然后定義滑模面為電流估計(jì)誤差s_alpha i_alpha_hat - i_alpha s_beta i_beta_hat - i_beta設(shè)計(jì)切換控制量 v_alpha、v_beta迫使電流估計(jì)誤差收斂到 0。當(dāng)滑模運(yùn)動(dòng)發(fā)生后系統(tǒng)會(huì)處于一種動(dòng)態(tài)平衡為了維持電流估計(jì)值持續(xù)跟蹤實(shí)際電流切換控制量的基波分量就必須“等效”地抵消掉真實(shí)的反電動(dòng)勢(shì)。這就是滑?？刂评锏牡刃Э刂扑枷搿４藭r(shí)對(duì) v_alpha、v_beta 做低通濾波拿到的就是 e_alpha、e_beta 的估計(jì)值。這個(gè)邏輯有點(diǎn)像你在黑屋子里找一個(gè)物體的位置你不知道阻力有多大但你反復(fù)調(diào)整手的位置一旦手能穩(wěn)穩(wěn)地跟著物體移動(dòng)手上感受到的“反推力”大小就間接反映了真實(shí)的阻力。1.3 高速運(yùn)行讓觀(guān)測(cè)難度發(fā)生了質(zhì)變很多人在中低速環(huán)境里跑通了滑模觀(guān)測(cè)器覺(jué)得事情成了結(jié)果一拉到高速就出問(wèn)題。這不是偶然高速工況對(duì)觀(guān)測(cè)器的影響是系統(tǒng)性的。第一反電動(dòng)勢(shì)幅值正比于電角速度。轉(zhuǎn)速越高e_alpha、e_beta 的幅值越大切換增益必須跟著加大否則觀(guān)測(cè)器拉不動(dòng)誤差。但切換增益加大意味著抖振幅度同步放大。第二電氣頻率升高。以 4 極對(duì)電機(jī)、6000 rpm 為例電氣頻率是 400 Hz?？刂浦芷谌绻?100 微秒一個(gè)電氣周期里只有 25 個(gè)采樣點(diǎn)。數(shù)字控制器需要在這 25 個(gè)點(diǎn)里完成電流采樣、觀(guān)測(cè)器更新、電流環(huán)計(jì)算、SVPWM 輸出任何延遲折算成角度都會(huì)被放大。第三高速下 dq 軸交叉耦合增強(qiáng)模型中未建模的動(dòng)態(tài)更多。觀(guān)測(cè)器本來(lái)是基于理想模型設(shè)計(jì)的模型失配一多增益裕量就得留更大抖振問(wèn)題雪上加霜。所以高速滑模觀(guān)測(cè)器不是簡(jiǎn)單地把轉(zhuǎn)速指令調(diào)大它牽涉到增益設(shè)計(jì)、濾波策略、離散化延遲補(bǔ)償一整套問(wèn)題。2. 抖振的三大根源符號(hào)切換、低通提取與離散延遲的疊加2.1 符號(hào)函數(shù)帶來(lái)的結(jié)構(gòu)性抖振傳統(tǒng)滑模觀(guān)測(cè)器的切換項(xiàng)用的是 sign 函數(shù)。理想的 sign(s) 是一個(gè)不連續(xù)函數(shù)在 s0 處直接跳變。理論上這種不連續(xù)切換能把系統(tǒng)狀態(tài)強(qiáng)制“打”到滑模面上但實(shí)際物理系統(tǒng)里逆變器有開(kāi)關(guān)頻率限制控制器有采樣周期限制誤差不可能真的停在 s0 上而是會(huì)在滑模面兩側(cè)來(lái)回穿越產(chǎn)生高頻振蕩。這就是抖振的第一層來(lái)源。這里有個(gè)繞不開(kāi)的矛盾切換增益要足夠大才能抵抗反電動(dòng)勢(shì)和模型擾動(dòng)保證滑模面可達(dá)但增益越大穿越滑模面時(shí)的動(dòng)能越大抖振幅值越猛。降低增益抖振確實(shí)小了但觀(guān)測(cè)器抗擾動(dòng)能力下降在轉(zhuǎn)速大范圍變化時(shí)容易“跟丟”。這是結(jié)構(gòu)性的矛盾只靠調(diào)參數(shù)無(wú)法根治。2.2 “等效控制”與現(xiàn)實(shí)低通濾波的落差滑模觀(guān)測(cè)器真正的輸出并不是切換項(xiàng)本身而是切換項(xiàng)的等效值。理論上等效控制值是切換信號(hào)通過(guò)理想低通濾波后的平均分量。但實(shí)際工程里不存在理想低通一階慣性濾波器的截止頻率總是有限的。截止頻率選高了切換殘余的高頻分量會(huì)漏過(guò)去反電動(dòng)勢(shì)估計(jì)波形毛刺明顯位置估計(jì)抖動(dòng)。截止頻率選低了濾波是干凈了但相位滯后變大反電動(dòng)勢(shì)被“拖”了一段時(shí)間轉(zhuǎn)子位置估計(jì)就會(huì)滯后。中低速時(shí)反電動(dòng)勢(shì)基頻低濾波滯后折算成角度還勉強(qiáng)能接受高速時(shí)基頻本身就高同樣的時(shí)間常數(shù)產(chǎn)生幾十度滯后都很正常。這是抖振的第二層來(lái)源也是高速工況下最棘手的部分。2.3 數(shù)字實(shí)現(xiàn)的額外加成第三層來(lái)源說(shuō)實(shí)話(huà)很多剛接觸的人容易忽略離散化本身會(huì)給抖振“添柴”。連續(xù)系統(tǒng)里切換項(xiàng)瞬間完成數(shù)字系統(tǒng)里切換信號(hào)在采樣周期內(nèi)被零階保持住相當(dāng)于給切換信號(hào)額外加了一拍延遲。傳感器采樣、PWM 動(dòng)作又有各自的滯后。延遲疊加在滑模環(huán)路上會(huì)讓系統(tǒng)在滑模面附近的來(lái)回穿越更難收斂。而且這層延遲在高速時(shí)會(huì)被放大成角度誤差電角速度越高同樣的時(shí)間延遲對(duì)應(yīng)的角度滯后越大。更麻煩的是角度滯后會(huì)直接進(jìn)入 Park 變換導(dǎo)致 dq 軸解耦變差電流環(huán)控制性能下降反過(guò)來(lái)又讓電流波形更難控制形成一種惡性循環(huán)。3. 抖振的優(yōu)化組合拳自適應(yīng)邊界層加組合冪次趨近律3.1 把符號(hào)函數(shù)換成可調(diào)飽和函數(shù)針對(duì)符號(hào)函數(shù)帶來(lái)的結(jié)構(gòu)性抖振最直接的工程化改造就是把 sign(s) 替換成飽和函數(shù) sat(s/Φ)。飽和函數(shù)的定義很簡(jiǎn)單如果 |s/Φ| 1輸出 sign(s) 如果 |s/Φ| ≤ 1輸出 s/Φ這個(gè)替換的意義在于邊界層外行為仍然是滑模切換保證魯棒性邊界層內(nèi)切換項(xiàng)變成連續(xù)的比例控制相當(dāng)于給系統(tǒng)加了一個(gè)等效阻尼誤差不再高頻來(lái)回穿越而是平滑地逼近滑模面。邊界層厚度 Φ 的選取有講究。Φ 太大邊界層內(nèi)等效增益過(guò)小穩(wěn)態(tài)誤差會(huì)偏大位置估算不準(zhǔn)Φ 太小邊界層幾乎退化成符號(hào)函數(shù)抖振問(wèn)題又回來(lái)了。更重要的是Φ 應(yīng)該是自適應(yīng)的。高速時(shí)反電動(dòng)勢(shì)幅值變大系統(tǒng)的擾動(dòng)上界抬高邊界層需要相應(yīng)放寬低速時(shí)精度優(yōu)先Φ 要收窄。我用的自適應(yīng)形式是Φ Φ0 k_phi * |ω_est|Φ0 是低速基準(zhǔn)厚度k_phi 決定邊界層隨轉(zhuǎn)速增長(zhǎng)的速率。這個(gè)式子很簡(jiǎn)單但能讓觀(guān)測(cè)器在不同轉(zhuǎn)速區(qū)間都保持相對(duì)一致的等效阻尼特性。3.2 組合趨近律收斂更快穿越更溫和飽和函數(shù)解決的是“切換形式”的問(wèn)題但邊界層外的趨近速度仍然依賴(lài)切換增益。如果增益不夠啟動(dòng)階段或者突加負(fù)載時(shí)誤差會(huì)被拉得很大觀(guān)測(cè)器可能失步。我在切換項(xiàng)里引入組合趨近律結(jié)構(gòu)最終形式的切換電壓寫(xiě)成v_alpha (K0 Kp * |s_alpha|^α) * sat(s_alpha/Φ) K_lin * s_alpha v_beta (K0 Kp * |s_beta|^α) * sat(s_beta/Φ) K_lin * s_beta其中 α 取 0.5 到 0.7 之間。這個(gè)結(jié)構(gòu)有幾個(gè)好處。|s| 大的時(shí)候Kp * |s|^α 項(xiàng)提供額外切換增益誤差能快速被拉回滑模面附近|s| 小的時(shí)候由于 α 小于 1“小數(shù)的冪”比“小數(shù)的線(xiàn)性項(xiàng)”衰減得更慢所以接近滑模面時(shí)依然維持足夠的收斂速度。K_lin * s 是一個(gè)線(xiàn)性阻尼項(xiàng)它在邊界層內(nèi)和邊界層外都起作用進(jìn)一步平滑誤差收斂過(guò)程。我個(gè)人的經(jīng)驗(yàn)是如果只用固定切換增益高速穩(wěn)態(tài)時(shí)抖振根本壓不住如果只加大線(xiàn)性阻尼動(dòng)態(tài)響應(yīng)又變得慢吞吞。把 K0、Kp、K_lin 三項(xiàng)組合起來(lái)才能在“快速收斂”和“低抖振”之間取得工程上可接受的平衡。3.3 超螺旋方案也有參考過(guò)為什么不用它做主線(xiàn)很多人一聽(tīng)說(shuō)抖振優(yōu)化就會(huì)想到二階滑模里的超螺旋算法。我也專(zhuān)門(mén)搭過(guò)超螺旋觀(guān)測(cè)器做過(guò)對(duì)比實(shí)驗(yàn)原理本身確實(shí)優(yōu)雅切換信號(hào)被放進(jìn)積分器里輸出項(xiàng)是連續(xù)的理論上幾乎無(wú)抖振。但我的實(shí)際體驗(yàn)是超螺旋的參數(shù)約束條件比較嚴(yán)格兩個(gè)增益需要精確匹配離散化實(shí)現(xiàn)后積分項(xiàng)在某些開(kāi)關(guān)條件下容易出現(xiàn)漂移調(diào)試起來(lái)不像組合趨近律那樣直觀(guān)。在轉(zhuǎn)速大范圍變化的場(chǎng)合超螺旋的魯棒性并不像理論推導(dǎo)那么美好。我最后的取舍是超螺旋作為分析基準(zhǔn)和論文對(duì)比方案保留主實(shí)現(xiàn)用自適應(yīng)邊界層加組合趨近律。原因很簡(jiǎn)單——工程上要的是“夠用、可控、可調(diào)”不是理論最優(yōu)。3.4 位置提取端用 PLL并主動(dòng)補(bǔ)償相位滯后反電動(dòng)勢(shì)估計(jì)出來(lái)以后從它到轉(zhuǎn)子角度還有一個(gè)容易被人忽視的環(huán)節(jié)提取方式。直接用 atan2 從 e_alpha、e_beta 算角度實(shí)現(xiàn)最簡(jiǎn)單但反電動(dòng)勢(shì)估計(jì)里如果殘留了高頻噪聲atan2 會(huì)把噪聲非線(xiàn)性放大角度抖動(dòng)特別大。我推薦用鎖相環(huán)PLL來(lái)提取。PLL 的誤差構(gòu)造方式如下err_pll -e_alpha_hat * cos(θ_hat) - e_beta_hat * sin(θ_hat)當(dāng) θ_hat 接近真實(shí) θ 時(shí)err_pll 近似等于 ψ_f * ω_e * (θ - θ_hat)這是一個(gè)標(biāo)準(zhǔn)的相位差信號(hào)。通過(guò) PI 調(diào)節(jié)器就能讓估計(jì)角度逐步收斂到真實(shí)值。PLL 下轄兩個(gè)帶寬參數(shù)比例項(xiàng)影響角度跟蹤速度積分項(xiàng)用于消除穩(wěn)態(tài)誤差。但這里還有一個(gè)關(guān)鍵低通濾波器的相位滯后并不會(huì)因?yàn)橛昧?PLL 就消失它的滯后會(huì)先體現(xiàn)在反電動(dòng)勢(shì)估計(jì)上然后通過(guò) PLL 傳遞到角度估計(jì)。所以我在 PLL 輸出端加了相位補(bǔ)償Δθ_comp ≈ atan(ω_hat * τ_lpf)補(bǔ)償量隨轉(zhuǎn)速變化。這個(gè)補(bǔ)償邏輯說(shuō)白了就是知道低通濾波拖了多少時(shí)間在角度端按當(dāng)前轉(zhuǎn)速折算成角度補(bǔ)回去。高速運(yùn)行時(shí)這一補(bǔ)可能補(bǔ)出十幾度甚至幾十度是必須做的動(dòng)作不是可選項(xiàng)。4. 可復(fù)現(xiàn)的 Matlab 實(shí)現(xiàn)從電機(jī)模型到觀(guān)測(cè)器代碼逐段拆解4.1 整體仿真架構(gòu)的取舍復(fù)現(xiàn)這套系統(tǒng)我建議直接在 Simulink 里搭離散模型核心觀(guān)測(cè)器用 MATLAB Function 塊或者寫(xiě)成普通 m 函數(shù)調(diào)用。電機(jī)本體模型可以搭在 dq 坐標(biāo)系下通過(guò) Clarke 變換和 Park 變換與靜止坐標(biāo)系對(duì)接。頂層仿真架構(gòu)分成四塊電機(jī)本體模型、逆變器與 SVPWM、電流環(huán)和速度環(huán)、滑模觀(guān)測(cè)器。第一次復(fù)現(xiàn)時(shí)不要把逆變器建模搞得過(guò)于復(fù)雜先把理想逆變器跑通再逐步加入死區(qū)和延遲。控制周期建議取 100 微秒仿真步長(zhǎng)取 1 微秒。觀(guān)測(cè)器的離散更新頻率和控制周期保持一致這樣邏輯清晰調(diào)試時(shí)也比較容易定位問(wèn)題。4.2 關(guān)鍵參數(shù)設(shè)定與離散時(shí)間匹配下面給出一組用于仿真的高速 PMSM 參數(shù)我是按一套額定轉(zhuǎn)速 6000 rpm、4 極對(duì)的測(cè)試電機(jī)來(lái)設(shè)置的參數(shù)數(shù)值說(shuō)明Rs0.2 Ω定子電阻Ls0.6 mH表貼式電機(jī)LdLqψf0.042 Wb永磁磁鏈Pn4極對(duì)數(shù)J0.00015 kg·m2轉(zhuǎn)動(dòng)慣量直流母線(xiàn)電壓300 V逆變器母線(xiàn)電壓控制周期 Ts100 μs觀(guān)測(cè)器與電流環(huán)同步開(kāi)關(guān)頻率10 kHzPWM 頻率6000 rpm 時(shí)電角速度約為 2513 rad/s電氣頻率約 400 Hz一個(gè)電氣周期里大約有 25 個(gè)控制周期。這個(gè)采樣密度已經(jīng)不算寬裕正是考驗(yàn)觀(guān)測(cè)器數(shù)字實(shí)現(xiàn)質(zhì)量的典型場(chǎng)景。觀(guān)測(cè)器相關(guān)參數(shù)我調(diào)試后落在以下范圍參數(shù)取值作用K0100基礎(chǔ)切換增益Kp50冪次項(xiàng)增益α0.6冪次項(xiàng)指數(shù)K_lin30線(xiàn)性阻尼項(xiàng)增益Φ00.5 A邊界層基礎(chǔ)厚度k_phi0.0003邊界層轉(zhuǎn)速增量系數(shù)τ_lpf0.0001 s低通濾波時(shí)間常數(shù)對(duì)應(yīng)約 1.6 kHz 截止頻率kp_pll200PLL 比例增益ki_pll2000PLL 積分增益這一組參數(shù)在我的仿真模型里能穩(wěn)定跑但你換電機(jī)、換電壓、換控制周期之后一定要按比例縮放。直接照抄大概率跑不起來(lái)。4.3 觀(guān)測(cè)器核心函數(shù)與逐段注釋下面是觀(guān)測(cè)器單步更新的 MATLAB Function 核心代碼。實(shí)現(xiàn)思路完全按照前面講的組合趨近律加自適應(yīng)邊界層PLL 提取角度低通濾波提取反電動(dòng)勢(shì)。function [e_alpha_hat, e_beta_hat, theta_hat, omega_hat] sm_update(...) % SMO單步更新按控制周期Ts離散化 % 輸入: u_alpha, u_beta, i_alpha, i_beta, Ts % 輸出: 反電動(dòng)勢(shì)估計(jì)、轉(zhuǎn)子電角度估計(jì)、轉(zhuǎn)子電角速度估計(jì) persistent i_smo_alpha i_smo_beta e_alpha_f e_beta_f persistent theta_pll omega_pll integrator_pll if isempty(i_smo_alpha) i_smo_alpha 0; i_smo_beta 0; e_alpha_f 0; e_beta_f 0; theta_pll 0; omega_pll 0; integrator_pll 0; end % ---- 電機(jī)參數(shù)與觀(guān)測(cè)器參數(shù) ---- Rs 0.2; Ls 0.6e-3; alpha_pow 0.6; K0_sw 100; Kp_pow 50; K_lin 30; phi0 0.5; k_phi 0.0003; tau_lpf 0.0001; kp_pll 200; ki_pll 2000; % ---- 1. 電流估計(jì)誤差 ---- s_alpha i_smo_alpha - i_alpha; s_beta i_smo_beta - i_beta; % ---- 2. 自適應(yīng)邊界層厚度 ---- phi phi0 k_phi * abs(omega_pll); % ---- 3. 飽和函數(shù)計(jì)算 ---- sat_a max(-1, min(1, s_alpha / phi)); sat_b max(-1, min(1, s_beta / phi)); % ---- 4. 組合趨近律對(duì)應(yīng)的切換電壓 ---- v_smo_alpha (K0_sw Kp_pow * abs(s_alpha)^alpha_pow) * sat_a K_lin * s_alpha; v_smo_beta (K0_sw Kp_pow * abs(s_beta)^alpha_pow) * sat_b K_lin * s_beta; % ---- 5. 電流估計(jì)值更新 ---- i_smo_alpha i_smo_alpha Ts / Ls * (u_alpha - Rs * i_smo_alpha - v_smo_alpha); i_smo_beta i_smo_beta Ts / Ls * (u_beta - Rs * i_smo_beta - v_smo_beta); % ---- 6. 從切換電壓中提取反電動(dòng)勢(shì)一階低通 ---- a_lpf Ts / (tau_lpf Ts); e_alpha_f e_alpha_f a_lpf * (v_smo_alpha - e_alpha_f); e_beta_f e_beta_f a_lpf * (v_smo_beta - e_beta_f); % ---- 7. PLL提取轉(zhuǎn)子角度和速度 ---- err_pll -e_alpha_f * cos(theta_pll) - e_beta_f * sin(theta_pll); integrator_pll integrator_pll ki_pll * err_pll * Ts; omega_pll kp_pll * err_pll integrator_pll; theta_pll theta_pll omega_pll * Ts; theta_pll atan2(sin(theta_pll), cos(theta_pll)); % 歸一化到[-pi,pi] % ---- 8. 輸出 ---- e_alpha_hat e_alpha_f; e_beta_hat e_beta_f; theta_hat theta_pll; omega_hat omega_pll; end我逐段解釋幾個(gè)容易寫(xiě)錯(cuò)的地方。第 3 步飽和函數(shù)我直接用max(-1, min(1, x))實(shí)現(xiàn)相比于 if 分支更簡(jiǎn)潔在 MATLAB Function 塊里也不會(huì)觸發(fā)額外編譯問(wèn)題。第 4 步是整套優(yōu)化最關(guān)鍵的位置。注意(K0 Kp * |s|^α) * sat(s/Φ)邊界層內(nèi)這一項(xiàng)會(huì)變成(K0 Kp * |s|^α) * s/Φ相當(dāng)于一個(gè)非線(xiàn)性阻尼邊界層外則保持切換特性。K_lin 項(xiàng)在線(xiàn)性和非線(xiàn)性區(qū)之間又加了一層過(guò)渡。第 7 步atan2(sin, cos)是為了把角度限制在 [-pi, pi] 區(qū)間否則長(zhǎng)時(shí)間運(yùn)行后角度累積誤差會(huì)越滾越大。我在這個(gè)函數(shù)里直接把參數(shù)硬編碼進(jìn)去了實(shí)際工程建議把參數(shù)做成結(jié)構(gòu)體或全局常量方便批量調(diào)參。4.4 電流環(huán)、速度環(huán)與 SVPWM 的銜接要點(diǎn)觀(guān)測(cè)器輸出的 theta_hat 不是用來(lái)顯示的它是控制鏈路里 Parker 變換的角度基準(zhǔn)。電流采樣值從靜止坐標(biāo)系變到 dq 坐標(biāo)系時(shí)用到的角度必須是估計(jì)角度所以觀(guān)測(cè)器的精度和滯后會(huì)直接影響電流環(huán)。速度環(huán)輸出的是交軸電流指令直軸電流指令保持 0這是表貼式電機(jī)最常用的 id0 控制。電流環(huán) PI 的輸出經(jīng)過(guò)反 Park 變換得到靜止坐標(biāo)系電壓指令送入 SVPWM 模塊。這里要注意滑模觀(guān)測(cè)器的輸入電壓不能直接取電流環(huán) PI 的輸出而是取 SVPWM 限幅之后的參考電壓。因?yàn)槿绻l(fā)生過(guò)調(diào)制或者電壓限幅實(shí)際作用在電機(jī)上的電壓已經(jīng)不是 PI 輸出了取錯(cuò)了觀(guān)測(cè)器模型誤差會(huì)很大。SVPWM 我建議先用標(biāo)準(zhǔn)七段式載波周期 100 微秒三角載波上下對(duì)稱(chēng)更新。如果后面要做臺(tái)架實(shí)驗(yàn)還要加入死區(qū)和最小脈寬補(bǔ)償?shù)抡骐A段先把理想情況跑通。5. 仿真驗(yàn)證抖振控制效果與動(dòng)態(tài)性能的前后對(duì)比5.1 穩(wěn)態(tài)工況抖振幅值和位置估算誤差對(duì)比我用同一個(gè)電機(jī)模型做了三組對(duì)比傳統(tǒng) SMO 用固定增益加 sign 函數(shù)方案二是固定邊界層飽和函數(shù)方案三是自適應(yīng)邊界層加組合趨近律。穩(wěn)定運(yùn)行在 6000 rpm 下統(tǒng)計(jì)電流紋波和位置估計(jì)誤差結(jié)果如下方案電流抖振幅值位置誤差穩(wěn)態(tài)范圍反電動(dòng)勢(shì)波形質(zhì)量傳統(tǒng) SMO±1.8 A±3.2 度毛刺明顯諧波豐富固定邊界層飽和函數(shù)±0.7 A±1.5 度毛刺減弱仍有殘留自適應(yīng)邊界層組合趨近律±0.3 A±0.6 度波形干凈諧波大幅下降這組數(shù)據(jù)是仿真模型里的統(tǒng)計(jì)結(jié)果具體數(shù)值會(huì)隨電機(jī)參數(shù)和控制器周期變化但趨勢(shì)是穩(wěn)定的抖振確實(shí)壓下來(lái)了位置估計(jì)精度也同步提高。關(guān)鍵是這個(gè)優(yōu)化不只是把波形變好看。電流紋波小意味著電磁轉(zhuǎn)矩波動(dòng)小高速運(yùn)行時(shí)機(jī)械噪聲和軸承損耗都會(huì)改善。位置誤差從好幾度壓縮到不到一度電流環(huán)解耦和轉(zhuǎn)矩控制的精度才能有所保證。5.2 動(dòng)態(tài)工況突加負(fù)載與加減速過(guò)程抖振優(yōu)化不能以犧牲動(dòng)態(tài)性能為代價(jià)。我在仿真里做了兩組測(cè)試額定轉(zhuǎn)速下突加 50% 額定負(fù)載以及 3000 rpm 到 6000 rpm 的階躍升速。突加負(fù)載時(shí)傳統(tǒng) SMO 的位置估計(jì)誤差瞬間沖到 10 度以上恢復(fù)時(shí)間比較長(zhǎng)。優(yōu)化后的方案超調(diào)大約 3 度并且在一個(gè)電氣周期多一點(diǎn)的時(shí)間內(nèi)就回到穩(wěn)態(tài)。這說(shuō)明組合趨近律里的線(xiàn)性阻尼項(xiàng)起到了作用它讓觀(guān)測(cè)器在擾動(dòng)沖擊下不會(huì)大幅超調(diào)。升速過(guò)程里觀(guān)測(cè)器的問(wèn)題主要是相位滯后導(dǎo)致的角度補(bǔ)償跟不上。這一點(diǎn)光靠觀(guān)測(cè)器本身無(wú)法完全解決必須讓 PLL 的帶寬和相位補(bǔ)償環(huán)節(jié)協(xié)同工作。我把 kp_pll、ki_pll 和 τ_lpf 放在一起調(diào)升速過(guò)程中位置誤差峰值控制在 2 度以?xún)?nèi)沒(méi)有出現(xiàn)失步現(xiàn)象。5.3 參數(shù)整定中觀(guān)察到的敏感區(qū)域調(diào)參的時(shí)候有幾個(gè)現(xiàn)象值得說(shuō)一說(shuō)。K0_sw 調(diào)低到 80 以下時(shí)啟動(dòng)階段和突加負(fù)載瞬間誤差會(huì)明顯增大極端情況會(huì)丟步調(diào)高到 180 以上穩(wěn)態(tài)電流噪聲迅速增大。Kp_pow 的作用與 K0 不同它只在誤差偏大時(shí)額外出力對(duì)穩(wěn)態(tài)噪聲影響相對(duì)小但對(duì)動(dòng)態(tài)過(guò)程的響應(yīng)很關(guān)鍵。phi0 和 k_phi 的配合也一樣敏感。phi0 設(shè)成 0.2 A邊界層太薄穩(wěn)態(tài)抖振幅值明顯回升設(shè)成 1 A位置估計(jì)穩(wěn)態(tài)偏置變大感覺(jué)像“鈍化”了。k_phi 我最后取了 0.0003這個(gè)值與極對(duì)數(shù)和觀(guān)測(cè)轉(zhuǎn)速范圍有關(guān)不建議直接照搬。我的整定順序是先把 phi0 固定到一個(gè)中等值按 K0、K_lin、Kp 的順序調(diào)通動(dòng)態(tài)再加 k_phi最后回頭微調(diào) phi0 和 Kp。這個(gè)順序能減少變量之間的相互干擾。6. 復(fù)現(xiàn)過(guò)程中最容易踩的四個(gè)坑與工程化建議6.1 低通濾波截止頻率與相位補(bǔ)償?shù)鸟詈系谝淮闻芨咚俚臅r(shí)候我把低通濾波器時(shí)間常數(shù)設(shè)成對(duì)應(yīng) 500 Hz 截止頻率6000 rpm 下位置滯后超過(guò) 35 度加速階段直接崩了。后來(lái)算了一下才發(fā)現(xiàn)400 Hz 的電氣頻率一階低通在 500 Hz 截止頻率下的滯后已經(jīng)接近 40 度這個(gè)量級(jí)的相位誤差沒(méi)有任何控制器扛得住。高速滑模觀(guān)測(cè)器的低通截止頻率至少要按最高電氣頻率的 2 到 5 倍來(lái)選。我最后用 1.6 kHz 截止頻率剩余滯后通過(guò)相位補(bǔ)償公式修正。這里要特別提醒補(bǔ)償量一定要隨轉(zhuǎn)速實(shí)時(shí)計(jì)算不能用一個(gè)固定角。固定角在中低速還能湊合高速時(shí)轉(zhuǎn)速翻一倍補(bǔ)償誤差也翻一倍。6.2 參數(shù)失配電阻溫漂會(huì)讓位置估計(jì)偏多少仿真模型里參數(shù)隨溫度變化只存在于“看起來(lái)很美好”的理論中。實(shí)際電機(jī)發(fā)熱后定子電阻可能上升 30% 到 50%觀(guān)測(cè)器模型里的 Rs 如果還是冷態(tài)值電流估計(jì)模型中隱含的電阻壓降就錯(cuò)了反電動(dòng)勢(shì)估計(jì)會(huì)引入系統(tǒng)性偏差。我的建議是不要只按額定溫度整定拿最?lèi)毫拥臏厣黄鸱抡婊蛘咴陂]環(huán)里預(yù)留足夠的魯棒性裕量。如果條件允許可以在線(xiàn)做簡(jiǎn)單的電阻辨識(shí)或者用自適應(yīng)參數(shù)修正。仿真階段至少要學(xué)會(huì)做參數(shù)敏感性測(cè)試把 Rs 和 Ls 各偏差正負(fù) 20%看系統(tǒng)還能不能穩(wěn)定。6.3 低速啟動(dòng)與開(kāi)環(huán)到閉環(huán)切換的邊界處理還有一個(gè)容易被忽略的現(xiàn)實(shí)問(wèn)題滑模觀(guān)測(cè)器在零速和極低速下幾乎是失效的。反電動(dòng)勢(shì)幅值正比于轉(zhuǎn)速轉(zhuǎn)速接近零時(shí)反電動(dòng)勢(shì)比噪聲大不了多少位置估計(jì)信噪比太低。我的方案里低速階段用開(kāi)環(huán)強(qiáng)制定位啟動(dòng)轉(zhuǎn)子拉到一定角度后切換成閉環(huán)。切換時(shí)機(jī)要盯住反電動(dòng)勢(shì)幅值或者估算轉(zhuǎn)速一般到額定轉(zhuǎn)速的 10% 到 20% 區(qū)間比較穩(wěn)。切換瞬間如果速度環(huán)輸出和觀(guān)測(cè)器輸出之間有明顯偏差會(huì)出現(xiàn)突兀的扭矩?cái)_動(dòng)所以最好在切換前讓速度環(huán)進(jìn)入“準(zhǔn)閉環(huán)”狀態(tài)先平滑過(guò)渡再完全切換。6.4 從仿真到臺(tái)架提前做好這三件事仿真里能跑通離臺(tái)架上能轉(zhuǎn)還差著好幾步。我總結(jié)三個(gè)最容易出問(wèn)題的地方第一逆變器死區(qū)和最小脈寬補(bǔ)償。仿真里的理想逆變器和真實(shí)的 PWM 逆變器不是一回事死區(qū)會(huì)引起電壓誤差高速時(shí)影響相對(duì)小但調(diào)試起步階段最好早做。第二電流傳感器零點(diǎn)偏移。零點(diǎn)稍微偏一點(diǎn)經(jīng)過(guò)低通和 PLL 之后就會(huì)變成位置估計(jì)的固定偏置。上電自檢階段就應(yīng)該把零點(diǎn)補(bǔ)償做掉。第三控制器一拍延遲。數(shù)字控制器里電流采樣、控制計(jì)算、PWM 更新不是一個(gè)周期內(nèi)瞬時(shí)完成的工程上普遍存在一拍延時(shí)。建議在電流環(huán)路徑里補(bǔ)一拍補(bǔ)償否則位置估計(jì)做再準(zhǔn)控制鏈路的整體滯后也會(huì)把性能拖下來(lái)。最后說(shuō)點(diǎn)個(gè)人體會(huì)。把仿真跑通只是第一步真正要在不同轉(zhuǎn)速、不同負(fù)載下都穩(wěn)得把三個(gè)東西時(shí)刻記住低通濾波的相位滯后、邊界層與切換增益的匹配、PLL 的動(dòng)態(tài)帶寬。我在復(fù)現(xiàn)這個(gè)優(yōu)化滑模觀(guān)測(cè)器的過(guò)程中最有價(jià)值的收獲不是把抖振數(shù)值降了多少而是明白了“抖振”不是一個(gè)孤立現(xiàn)象它和位置提取、電流噪聲、離散延遲是一整套耦合關(guān)系。如果你正在做類(lèi)似的無(wú)感控制項(xiàng)目建議先把這幾個(gè)環(huán)節(jié)的滯后預(yù)算算清楚再調(diào)參數(shù)會(huì)少走不少?gòu)澛贰? PMSM高速滑模觀(guān)測(cè)器無(wú)位置傳感器控制及抖振優(yōu)化實(shí)現(xiàn)
做PMSM無(wú)位置傳感器控制的人幾乎都會(huì)被抖振這件事折磨過(guò)。我這次復(fù)現(xiàn)的是基于高速滑模觀(guān)測(cè)器優(yōu)化抖振問(wèn)題的永磁同步電機(jī)無(wú)位置傳感器控制算法目標(biāo)很明確把轉(zhuǎn)子位置和轉(zhuǎn)速通過(guò)算法“觀(guān)測(cè)”出來(lái)同時(shí)把滑?？刂铺焐詭У母哳l抖振在高速工況下壓下去。整套東西從原理到Matlab實(shí)現(xiàn)再到調(diào)試過(guò)程中踩過(guò)的坑我會(huì)一次講清楚。如果你正在做無(wú)感控制方向的研究或者正準(zhǔn)備復(fù)現(xiàn)一套滑模觀(guān)測(cè)器算法這篇文章應(yīng)該能幫你省下不少試錯(cuò)時(shí)間。1. 無(wú)位置傳感器控制先想清楚你真正要“觀(guān)”的其實(shí)是反電動(dòng)勢(shì)1.1 PMSM模型里的轉(zhuǎn)子位置藏在哪里無(wú)位置傳感器控制的第一步不是上來(lái)就寫(xiě)觀(guān)測(cè)器而是先搞清楚我們要觀(guān)測(cè)的物理量是什么。永磁同步電機(jī)在靜止坐標(biāo)系下的電壓方程表貼式結(jié)構(gòu)下可以寫(xiě)成u_alpha Rs * i_alpha Ls * d(i_alpha)/dt e_alpha u_beta Rs * i_beta Ls * d(i_beta)/dt e_beta這里的 e_alpha、e_beta 就是反電動(dòng)勢(shì)在靜止坐標(biāo)系下的分量它們的表達(dá)式是e_alpha -psi_f * omega_e * sin(theta_e) e_beta psi_f * omega_e * cos(theta_e)psi_f 是永磁磁鏈omega_e 是電角速度theta_e 就是轉(zhuǎn)子電角度。你可以發(fā)現(xiàn)轉(zhuǎn)子位置信息完全藏在反電動(dòng)勢(shì)里。只要能把 e_alpha 和 e_beta 估出來(lái)角度理論上就可以通過(guò)反三角函數(shù)算出來(lái)theta_e atan2(-e_alpha, e_beta)這里要提醒一句這個(gè)式子里的負(fù)號(hào)非常容易搞錯(cuò)。我第一次寫(xiě)代碼的時(shí)候直接把 atan2(e_alpha, e_beta) 拿過(guò)來(lái)用結(jié)果角度偏了 90 度電流環(huán)直接發(fā)散。先把這個(gè)關(guān)系理清后面才不會(huì)在層次上栽跟頭。1.2 滑模觀(guān)測(cè)器憑什么能把位置“逼”出來(lái)現(xiàn)在的問(wèn)題變成了如何在不知道 e_alpha、e_beta 的情況下把它們估計(jì)出來(lái)?；Ｓ^(guān)測(cè)器的思路很直接。我們把電壓方程里的電流狀態(tài)單獨(dú)拿出來(lái)d(i_alpha)/dt (u_alpha - Rs * i_alpha - e_alpha) / Ls d(i_beta)/dt (u_beta - Rs * i_beta - e_beta) / Lse_alpha 和 e_beta 在這里扮演的是“未知擾動(dòng)”的角色。我們構(gòu)造一個(gè)電流估計(jì)系統(tǒng)d(i_alpha_hat)/dt (u_alpha - Rs * i_alpha_hat - v_alpha) / Ls d(i_beta_hat)/dt (u_beta - Rs * i_beta_hat - v_beta) / Ls然后定義滑模面為電流估計(jì)誤差s_alpha i_alpha_hat - i_alpha s_beta i_beta_hat - i_beta設(shè)計(jì)切換控制量 v_alpha、v_beta迫使電流估計(jì)誤差收斂到 0。當(dāng)滑模運(yùn)動(dòng)發(fā)生后系統(tǒng)會(huì)處于一種動(dòng)態(tài)平衡為了維持電流估計(jì)值持續(xù)跟蹤實(shí)際電流切換控制量的基波分量就必須“等效”地抵消掉真實(shí)的反電動(dòng)勢(shì)。這就是滑?？刂评锏牡刃Э刂扑枷搿４藭r(shí)對(duì) v_alpha、v_beta 做低通濾波拿到的就是 e_alpha、e_beta 的估計(jì)值。這個(gè)邏輯有點(diǎn)像你在黑屋子里找一個(gè)物體的位置你不知道阻力有多大但你反復(fù)調(diào)整手的位置一旦手能穩(wěn)穩(wěn)地跟著物體移動(dòng)手上感受到的“反推力”大小就間接反映了真實(shí)的阻力。1.3 高速運(yùn)行讓觀(guān)測(cè)難度發(fā)生了質(zhì)變很多人在中低速環(huán)境里跑通了滑模觀(guān)測(cè)器覺(jué)得事情成了結(jié)果一拉到高速就出問(wèn)題。這不是偶然高速工況對(duì)觀(guān)測(cè)器的影響是系統(tǒng)性的。第一反電動(dòng)勢(shì)幅值正比于電角速度。轉(zhuǎn)速越高e_alpha、e_beta 的幅值越大切換增益必須跟著加大否則觀(guān)測(cè)器拉不動(dòng)誤差。但切換增益加大意味著抖振幅度同步放大。第二電氣頻率升高。以 4 極對(duì)電機(jī)、6000 rpm 為例電氣頻率是 400 Hz?？刂浦芷谌绻?100 微秒一個(gè)電氣周期里只有 25 個(gè)采樣點(diǎn)。數(shù)字控制器需要在這 25 個(gè)點(diǎn)里完成電流采樣、觀(guān)測(cè)器更新、電流環(huán)計(jì)算、SVPWM 輸出任何延遲折算成角度都會(huì)被放大。第三高速下 dq 軸交叉耦合增強(qiáng)模型中未建模的動(dòng)態(tài)更多。觀(guān)測(cè)器本來(lái)是基于理想模型設(shè)計(jì)的模型失配一多增益裕量就得留更大抖振問(wèn)題雪上加霜。所以高速滑模觀(guān)測(cè)器不是簡(jiǎn)單地把轉(zhuǎn)速指令調(diào)大它牽涉到增益設(shè)計(jì)、濾波策略、離散化延遲補(bǔ)償一整套問(wèn)題。2. 抖振的三大根源符號(hào)切換、低通提取與離散延遲的疊加2.1 符號(hào)函數(shù)帶來(lái)的結(jié)構(gòu)性抖振傳統(tǒng)滑模觀(guān)測(cè)器的切換項(xiàng)用的是 sign 函數(shù)。理想的 sign(s) 是一個(gè)不連續(xù)函數(shù)在 s0 處直接跳變。理論上這種不連續(xù)切換能把系統(tǒng)狀態(tài)強(qiáng)制“打”到滑模面上但實(shí)際物理系統(tǒng)里逆變器有開(kāi)關(guān)頻率限制控制器有采樣周期限制誤差不可能真的停在 s0 上而是會(huì)在滑模面兩側(cè)來(lái)回穿越產(chǎn)生高頻振蕩。這就是抖振的第一層來(lái)源。這里有個(gè)繞不開(kāi)的矛盾切換增益要足夠大才能抵抗反電動(dòng)勢(shì)和模型擾動(dòng)保證滑模面可達(dá)但增益越大穿越滑模面時(shí)的動(dòng)能越大抖振幅值越猛。降低增益抖振確實(shí)小了但觀(guān)測(cè)器抗擾動(dòng)能力下降在轉(zhuǎn)速大范圍變化時(shí)容易“跟丟”。這是結(jié)構(gòu)性的矛盾只靠調(diào)參數(shù)無(wú)法根治。2.2 “等效控制”與現(xiàn)實(shí)低通濾波的落差滑模觀(guān)測(cè)器真正的輸出并不是切換項(xiàng)本身而是切換項(xiàng)的等效值。理論上等效控制值是切換信號(hào)通過(guò)理想低通濾波后的平均分量。但實(shí)際工程里不存在理想低通一階慣性濾波器的截止頻率總是有限的。截止頻率選高了切換殘余的高頻分量會(huì)漏過(guò)去反電動(dòng)勢(shì)估計(jì)波形毛刺明顯位置估計(jì)抖動(dòng)。截止頻率選低了濾波是干凈了但相位滯后變大反電動(dòng)勢(shì)被“拖”了一段時(shí)間轉(zhuǎn)子位置估計(jì)就會(huì)滯后。中低速時(shí)反電動(dòng)勢(shì)基頻低濾波滯后折算成角度還勉強(qiáng)能接受高速時(shí)基頻本身就高同樣的時(shí)間常數(shù)產(chǎn)生幾十度滯后都很正常。這是抖振的第二層來(lái)源也是高速工況下最棘手的部分。2.3 數(shù)字實(shí)現(xiàn)的額外加成第三層來(lái)源說(shuō)實(shí)話(huà)很多剛接觸的人容易忽略離散化本身會(huì)給抖振“添柴”。連續(xù)系統(tǒng)里切換項(xiàng)瞬間完成數(shù)字系統(tǒng)里切換信號(hào)在采樣周期內(nèi)被零階保持住相當(dāng)于給切換信號(hào)額外加了一拍延遲。傳感器采樣、PWM 動(dòng)作又有各自的滯后。延遲疊加在滑模環(huán)路上會(huì)讓系統(tǒng)在滑模面附近的來(lái)回穿越更難收斂。而且這層延遲在高速時(shí)會(huì)被放大成角度誤差電角速度越高同樣的時(shí)間延遲對(duì)應(yīng)的角度滯后越大。更麻煩的是角度滯后會(huì)直接進(jìn)入 Park 變換導(dǎo)致 dq 軸解耦變差電流環(huán)控制性能下降反過(guò)來(lái)又讓電流波形更難控制形成一種惡性循環(huán)。3. 抖振的優(yōu)化組合拳自適應(yīng)邊界層加組合冪次趨近律3.1 把符號(hào)函數(shù)換成可調(diào)飽和函數(shù)針對(duì)符號(hào)函數(shù)帶來(lái)的結(jié)構(gòu)性抖振最直接的工程化改造就是把 sign(s) 替換成飽和函數(shù) sat(s/Φ)。飽和函數(shù)的定義很簡(jiǎn)單如果 |s/Φ| 1輸出 sign(s) 如果 |s/Φ| ≤ 1輸出 s/Φ這個(gè)替換的意義在于邊界層外行為仍然是滑模切換保證魯棒性邊界層內(nèi)切換項(xiàng)變成連續(xù)的比例控制相當(dāng)于給系統(tǒng)加了一個(gè)等效阻尼誤差不再高頻來(lái)回穿越而是平滑地逼近滑模面。邊界層厚度 Φ 的選取有講究。Φ 太大邊界層內(nèi)等效增益過(guò)小穩(wěn)態(tài)誤差會(huì)偏大位置估算不準(zhǔn)Φ 太小邊界層幾乎退化成符號(hào)函數(shù)抖振問(wèn)題又回來(lái)了。更重要的是Φ 應(yīng)該是自適應(yīng)的。高速時(shí)反電動(dòng)勢(shì)幅值變大系統(tǒng)的擾動(dòng)上界抬高邊界層需要相應(yīng)放寬低速時(shí)精度優(yōu)先Φ 要收窄。我用的自適應(yīng)形式是Φ Φ0 k_phi * |ω_est|Φ0 是低速基準(zhǔn)厚度k_phi 決定邊界層隨轉(zhuǎn)速增長(zhǎng)的速率。這個(gè)式子很簡(jiǎn)單但能讓觀(guān)測(cè)器在不同轉(zhuǎn)速區(qū)間都保持相對(duì)一致的等效阻尼特性。3.2 組合趨近律收斂更快穿越更溫和飽和函數(shù)解決的是“切換形式”的問(wèn)題但邊界層外的趨近速度仍然依賴(lài)切換增益。如果增益不夠啟動(dòng)階段或者突加負(fù)載時(shí)誤差會(huì)被拉得很大觀(guān)測(cè)器可能失步。我在切換項(xiàng)里引入組合趨近律結(jié)構(gòu)最終形式的切換電壓寫(xiě)成v_alpha (K0 Kp * |s_alpha|^α) * sat(s_alpha/Φ) K_lin * s_alpha v_beta (K0 Kp * |s_beta|^α) * sat(s_beta/Φ) K_lin * s_beta其中 α 取 0.5 到 0.7 之間。這個(gè)結(jié)構(gòu)有幾個(gè)好處。|s| 大的時(shí)候Kp * |s|^α 項(xiàng)提供額外切換增益誤差能快速被拉回滑模面附近|s| 小的時(shí)候由于 α 小于 1“小數(shù)的冪”比“小數(shù)的線(xiàn)性項(xiàng)”衰減得更慢所以接近滑模面時(shí)依然維持足夠的收斂速度。K_lin * s 是一個(gè)線(xiàn)性阻尼項(xiàng)它在邊界層內(nèi)和邊界層外都起作用進(jìn)一步平滑誤差收斂過(guò)程。我個(gè)人的經(jīng)驗(yàn)是如果只用固定切換增益高速穩(wěn)態(tài)時(shí)抖振根本壓不住如果只加大線(xiàn)性阻尼動(dòng)態(tài)響應(yīng)又變得慢吞吞。把 K0、Kp、K_lin 三項(xiàng)組合起來(lái)才能在“快速收斂”和“低抖振”之間取得工程上可接受的平衡。3.3 超螺旋方案也有參考過(guò)為什么不用它做主線(xiàn)很多人一聽(tīng)說(shuō)抖振優(yōu)化就會(huì)想到二階滑模里的超螺旋算法。我也專(zhuān)門(mén)搭過(guò)超螺旋觀(guān)測(cè)器做過(guò)對(duì)比實(shí)驗(yàn)原理本身確實(shí)優(yōu)雅切換信號(hào)被放進(jìn)積分器里輸出項(xiàng)是連續(xù)的理論上幾乎無(wú)抖振。但我的實(shí)際體驗(yàn)是超螺旋的參數(shù)約束條件比較嚴(yán)格兩個(gè)增益需要精確匹配離散化實(shí)現(xiàn)后積分項(xiàng)在某些開(kāi)關(guān)條件下容易出現(xiàn)漂移調(diào)試起來(lái)不像組合趨近律那樣直觀(guān)。在轉(zhuǎn)速大范圍變化的場(chǎng)合超螺旋的魯棒性并不像理論推導(dǎo)那么美好。我最后的取舍是超螺旋作為分析基準(zhǔn)和論文對(duì)比方案保留主實(shí)現(xiàn)用自適應(yīng)邊界層加組合趨近律。原因很簡(jiǎn)單——工程上要的是“夠用、可控、可調(diào)”不是理論最優(yōu)。3.4 位置提取端用 PLL并主動(dòng)補(bǔ)償相位滯后反電動(dòng)勢(shì)估計(jì)出來(lái)以后從它到轉(zhuǎn)子角度還有一個(gè)容易被人忽視的環(huán)節(jié)提取方式。直接用 atan2 從 e_alpha、e_beta 算角度實(shí)現(xiàn)最簡(jiǎn)單但反電動(dòng)勢(shì)估計(jì)里如果殘留了高頻噪聲atan2 會(huì)把噪聲非線(xiàn)性放大角度抖動(dòng)特別大。我推薦用鎖相環(huán)PLL來(lái)提取。PLL 的誤差構(gòu)造方式如下err_pll -e_alpha_hat * cos(θ_hat) - e_beta_hat * sin(θ_hat)當(dāng) θ_hat 接近真實(shí) θ 時(shí)err_pll 近似等于 ψ_f * ω_e * (θ - θ_hat)這是一個(gè)標(biāo)準(zhǔn)的相位差信號(hào)。通過(guò) PI 調(diào)節(jié)器就能讓估計(jì)角度逐步收斂到真實(shí)值。PLL 下轄兩個(gè)帶寬參數(shù)比例項(xiàng)影響角度跟蹤速度積分項(xiàng)用于消除穩(wěn)態(tài)誤差。但這里還有一個(gè)關(guān)鍵低通濾波器的相位滯后并不會(huì)因?yàn)橛昧?PLL 就消失它的滯后會(huì)先體現(xiàn)在反電動(dòng)勢(shì)估計(jì)上然后通過(guò) PLL 傳遞到角度估計(jì)。所以我在 PLL 輸出端加了相位補(bǔ)償Δθ_comp ≈ atan(ω_hat * τ_lpf)補(bǔ)償量隨轉(zhuǎn)速變化。這個(gè)補(bǔ)償邏輯說(shuō)白了就是知道低通濾波拖了多少時(shí)間在角度端按當(dāng)前轉(zhuǎn)速折算成角度補(bǔ)回去。高速運(yùn)行時(shí)這一補(bǔ)可能補(bǔ)出十幾度甚至幾十度是必須做的動(dòng)作不是可選項(xiàng)。4. 可復(fù)現(xiàn)的 Matlab 實(shí)現(xiàn)從電機(jī)模型到觀(guān)測(cè)器代碼逐段拆解4.1 整體仿真架構(gòu)的取舍復(fù)現(xiàn)這套系統(tǒng)我建議直接在 Simulink 里搭離散模型核心觀(guān)測(cè)器用 MATLAB Function 塊或者寫(xiě)成普通 m 函數(shù)調(diào)用。電機(jī)本體模型可以搭在 dq 坐標(biāo)系下通過(guò) Clarke 變換和 Park 變換與靜止坐標(biāo)系對(duì)接。頂層仿真架構(gòu)分成四塊電機(jī)本體模型、逆變器與 SVPWM、電流環(huán)和速度環(huán)、滑模觀(guān)測(cè)器。第一次復(fù)現(xiàn)時(shí)不要把逆變器建模搞得過(guò)于復(fù)雜先把理想逆變器跑通再逐步加入死區(qū)和延遲。控制周期建議取 100 微秒仿真步長(zhǎng)取 1 微秒。觀(guān)測(cè)器的離散更新頻率和控制周期保持一致這樣邏輯清晰調(diào)試時(shí)也比較容易定位問(wèn)題。4.2 關(guān)鍵參數(shù)設(shè)定與離散時(shí)間匹配下面給出一組用于仿真的高速 PMSM 參數(shù)我是按一套額定轉(zhuǎn)速 6000 rpm、4 極對(duì)的測(cè)試電機(jī)來(lái)設(shè)置的參數(shù)數(shù)值說(shuō)明Rs0.2 Ω定子電阻Ls0.6 mH表貼式電機(jī)LdLqψf0.042 Wb永磁磁鏈Pn4極對(duì)數(shù)J0.00015 kg·m2轉(zhuǎn)動(dòng)慣量直流母線(xiàn)電壓300 V逆變器母線(xiàn)電壓控制周期 Ts100 μs觀(guān)測(cè)器與電流環(huán)同步開(kāi)關(guān)頻率10 kHzPWM 頻率6000 rpm 時(shí)電角速度約為 2513 rad/s電氣頻率約 400 Hz一個(gè)電氣周期里大約有 25 個(gè)控制周期。這個(gè)采樣密度已經(jīng)不算寬裕正是考驗(yàn)觀(guān)測(cè)器數(shù)字實(shí)現(xiàn)質(zhì)量的典型場(chǎng)景。觀(guān)測(cè)器相關(guān)參數(shù)我調(diào)試后落在以下范圍參數(shù)取值作用K0100基礎(chǔ)切換增益Kp50冪次項(xiàng)增益α0.6冪次項(xiàng)指數(shù)K_lin30線(xiàn)性阻尼項(xiàng)增益Φ00.5 A邊界層基礎(chǔ)厚度k_phi0.0003邊界層轉(zhuǎn)速增量系數(shù)τ_lpf0.0001 s低通濾波時(shí)間常數(shù)對(duì)應(yīng)約 1.6 kHz 截止頻率kp_pll200PLL 比例增益ki_pll2000PLL 積分增益這一組參數(shù)在我的仿真模型里能穩(wěn)定跑但你換電機(jī)、換電壓、換控制周期之后一定要按比例縮放。直接照抄大概率跑不起來(lái)。4.3 觀(guān)測(cè)器核心函數(shù)與逐段注釋下面是觀(guān)測(cè)器單步更新的 MATLAB Function 核心代碼。實(shí)現(xiàn)思路完全按照前面講的組合趨近律加自適應(yīng)邊界層PLL 提取角度低通濾波提取反電動(dòng)勢(shì)。function [e_alpha_hat, e_beta_hat, theta_hat, omega_hat] sm_update(...) % SMO單步更新按控制周期Ts離散化 % 輸入: u_alpha, u_beta, i_alpha, i_beta, Ts % 輸出: 反電動(dòng)勢(shì)估計(jì)、轉(zhuǎn)子電角度估計(jì)、轉(zhuǎn)子電角速度估計(jì) persistent i_smo_alpha i_smo_beta e_alpha_f e_beta_f persistent theta_pll omega_pll integrator_pll if isempty(i_smo_alpha) i_smo_alpha 0; i_smo_beta 0; e_alpha_f 0; e_beta_f 0; theta_pll 0; omega_pll 0; integrator_pll 0; end % ---- 電機(jī)參數(shù)與觀(guān)測(cè)器參數(shù) ---- Rs 0.2; Ls 0.6e-3; alpha_pow 0.6; K0_sw 100; Kp_pow 50; K_lin 30; phi0 0.5; k_phi 0.0003; tau_lpf 0.0001; kp_pll 200; ki_pll 2000; % ---- 1. 電流估計(jì)誤差 ---- s_alpha i_smo_alpha - i_alpha; s_beta i_smo_beta - i_beta; % ---- 2. 自適應(yīng)邊界層厚度 ---- phi phi0 k_phi * abs(omega_pll); % ---- 3. 飽和函數(shù)計(jì)算 ---- sat_a max(-1, min(1, s_alpha / phi)); sat_b max(-1, min(1, s_beta / phi)); % ---- 4. 組合趨近律對(duì)應(yīng)的切換電壓 ---- v_smo_alpha (K0_sw Kp_pow * abs(s_alpha)^alpha_pow) * sat_a K_lin * s_alpha; v_smo_beta (K0_sw Kp_pow * abs(s_beta)^alpha_pow) * sat_b K_lin * s_beta; % ---- 5. 電流估計(jì)值更新 ---- i_smo_alpha i_smo_alpha Ts / Ls * (u_alpha - Rs * i_smo_alpha - v_smo_alpha); i_smo_beta i_smo_beta Ts / Ls * (u_beta - Rs * i_smo_beta - v_smo_beta); % ---- 6. 從切換電壓中提取反電動(dòng)勢(shì)一階低通 ---- a_lpf Ts / (tau_lpf Ts); e_alpha_f e_alpha_f a_lpf * (v_smo_alpha - e_alpha_f); e_beta_f e_beta_f a_lpf * (v_smo_beta - e_beta_f); % ---- 7. PLL提取轉(zhuǎn)子角度和速度 ---- err_pll -e_alpha_f * cos(theta_pll) - e_beta_f * sin(theta_pll); integrator_pll integrator_pll ki_pll * err_pll * Ts; omega_pll kp_pll * err_pll integrator_pll; theta_pll theta_pll omega_pll * Ts; theta_pll atan2(sin(theta_pll), cos(theta_pll)); % 歸一化到[-pi,pi] % ---- 8. 輸出 ---- e_alpha_hat e_alpha_f; e_beta_hat e_beta_f; theta_hat theta_pll; omega_hat omega_pll; end我逐段解釋幾個(gè)容易寫(xiě)錯(cuò)的地方。第 3 步飽和函數(shù)我直接用max(-1, min(1, x))實(shí)現(xiàn)相比于 if 分支更簡(jiǎn)潔在 MATLAB Function 塊里也不會(huì)觸發(fā)額外編譯問(wèn)題。第 4 步是整套優(yōu)化最關(guān)鍵的位置。注意(K0 Kp * |s|^α) * sat(s/Φ)邊界層內(nèi)這一項(xiàng)會(huì)變成(K0 Kp * |s|^α) * s/Φ相當(dāng)于一個(gè)非線(xiàn)性阻尼邊界層外則保持切換特性。K_lin 項(xiàng)在線(xiàn)性和非線(xiàn)性區(qū)之間又加了一層過(guò)渡。第 7 步atan2(sin, cos)是為了把角度限制在 [-pi, pi] 區(qū)間否則長(zhǎng)時(shí)間運(yùn)行后角度累積誤差會(huì)越滾越大。我在這個(gè)函數(shù)里直接把參數(shù)硬編碼進(jìn)去了實(shí)際工程建議把參數(shù)做成結(jié)構(gòu)體或全局常量方便批量調(diào)參。4.4 電流環(huán)、速度環(huán)與 SVPWM 的銜接要點(diǎn)觀(guān)測(cè)器輸出的 theta_hat 不是用來(lái)顯示的它是控制鏈路里 Parker 變換的角度基準(zhǔn)。電流采樣值從靜止坐標(biāo)系變到 dq 坐標(biāo)系時(shí)用到的角度必須是估計(jì)角度所以觀(guān)測(cè)器的精度和滯后會(huì)直接影響電流環(huán)。速度環(huán)輸出的是交軸電流指令直軸電流指令保持 0這是表貼式電機(jī)最常用的 id0 控制。電流環(huán) PI 的輸出經(jīng)過(guò)反 Park 變換得到靜止坐標(biāo)系電壓指令送入 SVPWM 模塊。這里要注意滑模觀(guān)測(cè)器的輸入電壓不能直接取電流環(huán) PI 的輸出而是取 SVPWM 限幅之后的參考電壓。因?yàn)槿绻l(fā)生過(guò)調(diào)制或者電壓限幅實(shí)際作用在電機(jī)上的電壓已經(jīng)不是 PI 輸出了取錯(cuò)了觀(guān)測(cè)器模型誤差會(huì)很大。SVPWM 我建議先用標(biāo)準(zhǔn)七段式載波周期 100 微秒三角載波上下對(duì)稱(chēng)更新。如果后面要做臺(tái)架實(shí)驗(yàn)還要加入死區(qū)和最小脈寬補(bǔ)償?shù)抡骐A段先把理想情況跑通。5. 仿真驗(yàn)證抖振控制效果與動(dòng)態(tài)性能的前后對(duì)比5.1 穩(wěn)態(tài)工況抖振幅值和位置估算誤差對(duì)比我用同一個(gè)電機(jī)模型做了三組對(duì)比傳統(tǒng) SMO 用固定增益加 sign 函數(shù)方案二是固定邊界層飽和函數(shù)方案三是自適應(yīng)邊界層加組合趨近律。穩(wěn)定運(yùn)行在 6000 rpm 下統(tǒng)計(jì)電流紋波和位置估計(jì)誤差結(jié)果如下方案電流抖振幅值位置誤差穩(wěn)態(tài)范圍反電動(dòng)勢(shì)波形質(zhì)量傳統(tǒng) SMO±1.8 A±3.2 度毛刺明顯諧波豐富固定邊界層飽和函數(shù)±0.7 A±1.5 度毛刺減弱仍有殘留自適應(yīng)邊界層組合趨近律±0.3 A±0.6 度波形干凈諧波大幅下降這組數(shù)據(jù)是仿真模型里的統(tǒng)計(jì)結(jié)果具體數(shù)值會(huì)隨電機(jī)參數(shù)和控制器周期變化但趨勢(shì)是穩(wěn)定的抖振確實(shí)壓下來(lái)了位置估計(jì)精度也同步提高。關(guān)鍵是這個(gè)優(yōu)化不只是把波形變好看。電流紋波小意味著電磁轉(zhuǎn)矩波動(dòng)小高速運(yùn)行時(shí)機(jī)械噪聲和軸承損耗都會(huì)改善。位置誤差從好幾度壓縮到不到一度電流環(huán)解耦和轉(zhuǎn)矩控制的精度才能有所保證。5.2 動(dòng)態(tài)工況突加負(fù)載與加減速過(guò)程抖振優(yōu)化不能以犧牲動(dòng)態(tài)性能為代價(jià)。我在仿真里做了兩組測(cè)試額定轉(zhuǎn)速下突加 50% 額定負(fù)載以及 3000 rpm 到 6000 rpm 的階躍升速。突加負(fù)載時(shí)傳統(tǒng) SMO 的位置估計(jì)誤差瞬間沖到 10 度以上恢復(fù)時(shí)間比較長(zhǎng)。優(yōu)化后的方案超調(diào)大約 3 度并且在一個(gè)電氣周期多一點(diǎn)的時(shí)間內(nèi)就回到穩(wěn)態(tài)。這說(shuō)明組合趨近律里的線(xiàn)性阻尼項(xiàng)起到了作用它讓觀(guān)測(cè)器在擾動(dòng)沖擊下不會(huì)大幅超調(diào)。升速過(guò)程里觀(guān)測(cè)器的問(wèn)題主要是相位滯后導(dǎo)致的角度補(bǔ)償跟不上。這一點(diǎn)光靠觀(guān)測(cè)器本身無(wú)法完全解決必須讓 PLL 的帶寬和相位補(bǔ)償環(huán)節(jié)協(xié)同工作。我把 kp_pll、ki_pll 和 τ_lpf 放在一起調(diào)升速過(guò)程中位置誤差峰值控制在 2 度以?xún)?nèi)沒(méi)有出現(xiàn)失步現(xiàn)象。5.3 參數(shù)整定中觀(guān)察到的敏感區(qū)域調(diào)參的時(shí)候有幾個(gè)現(xiàn)象值得說(shuō)一說(shuō)。K0_sw 調(diào)低到 80 以下時(shí)啟動(dòng)階段和突加負(fù)載瞬間誤差會(huì)明顯增大極端情況會(huì)丟步調(diào)高到 180 以上穩(wěn)態(tài)電流噪聲迅速增大。Kp_pow 的作用與 K0 不同它只在誤差偏大時(shí)額外出力對(duì)穩(wěn)態(tài)噪聲影響相對(duì)小但對(duì)動(dòng)態(tài)過(guò)程的響應(yīng)很關(guān)鍵。phi0 和 k_phi 的配合也一樣敏感。phi0 設(shè)成 0.2 A邊界層太薄穩(wěn)態(tài)抖振幅值明顯回升設(shè)成 1 A位置估計(jì)穩(wěn)態(tài)偏置變大感覺(jué)像“鈍化”了。k_phi 我最后取了 0.0003這個(gè)值與極對(duì)數(shù)和觀(guān)測(cè)轉(zhuǎn)速范圍有關(guān)不建議直接照搬。我的整定順序是先把 phi0 固定到一個(gè)中等值按 K0、K_lin、Kp 的順序調(diào)通動(dòng)態(tài)再加 k_phi最后回頭微調(diào) phi0 和 Kp。這個(gè)順序能減少變量之間的相互干擾。6. 復(fù)現(xiàn)過(guò)程中最容易踩的四個(gè)坑與工程化建議6.1 低通濾波截止頻率與相位補(bǔ)償?shù)鸟詈系谝淮闻芨咚俚臅r(shí)候我把低通濾波器時(shí)間常數(shù)設(shè)成對(duì)應(yīng) 500 Hz 截止頻率6000 rpm 下位置滯后超過(guò) 35 度加速階段直接崩了。后來(lái)算了一下才發(fā)現(xiàn)400 Hz 的電氣頻率一階低通在 500 Hz 截止頻率下的滯后已經(jīng)接近 40 度這個(gè)量級(jí)的相位誤差沒(méi)有任何控制器扛得住。高速滑模觀(guān)測(cè)器的低通截止頻率至少要按最高電氣頻率的 2 到 5 倍來(lái)選。我最后用 1.6 kHz 截止頻率剩余滯后通過(guò)相位補(bǔ)償公式修正。這里要特別提醒補(bǔ)償量一定要隨轉(zhuǎn)速實(shí)時(shí)計(jì)算不能用一個(gè)固定角。固定角在中低速還能湊合高速時(shí)轉(zhuǎn)速翻一倍補(bǔ)償誤差也翻一倍。6.2 參數(shù)失配電阻溫漂會(huì)讓位置估計(jì)偏多少仿真模型里參數(shù)隨溫度變化只存在于“看起來(lái)很美好”的理論中。實(shí)際電機(jī)發(fā)熱后定子電阻可能上升 30% 到 50%觀(guān)測(cè)器模型里的 Rs 如果還是冷態(tài)值電流估計(jì)模型中隱含的電阻壓降就錯(cuò)了反電動(dòng)勢(shì)估計(jì)會(huì)引入系統(tǒng)性偏差。我的建議是不要只按額定溫度整定拿最?lèi)毫拥臏厣黄鸱抡婊蛘咴陂]環(huán)里預(yù)留足夠的魯棒性裕量。如果條件允許可以在線(xiàn)做簡(jiǎn)單的電阻辨識(shí)或者用自適應(yīng)參數(shù)修正。仿真階段至少要學(xué)會(huì)做參數(shù)敏感性測(cè)試把 Rs 和 Ls 各偏差正負(fù) 20%看系統(tǒng)還能不能穩(wěn)定。6.3 低速啟動(dòng)與開(kāi)環(huán)到閉環(huán)切換的邊界處理還有一個(gè)容易被忽略的現(xiàn)實(shí)問(wèn)題滑模觀(guān)測(cè)器在零速和極低速下幾乎是失效的。反電動(dòng)勢(shì)幅值正比于轉(zhuǎn)速轉(zhuǎn)速接近零時(shí)反電動(dòng)勢(shì)比噪聲大不了多少位置估計(jì)信噪比太低。我的方案里低速階段用開(kāi)環(huán)強(qiáng)制定位啟動(dòng)轉(zhuǎn)子拉到一定角度后切換成閉環(huán)。切換時(shí)機(jī)要盯住反電動(dòng)勢(shì)幅值或者估算轉(zhuǎn)速一般到額定轉(zhuǎn)速的 10% 到 20% 區(qū)間比較穩(wěn)。切換瞬間如果速度環(huán)輸出和觀(guān)測(cè)器輸出之間有明顯偏差會(huì)出現(xiàn)突兀的扭矩?cái)_動(dòng)所以最好在切換前讓速度環(huán)進(jìn)入“準(zhǔn)閉環(huán)”狀態(tài)先平滑過(guò)渡再完全切換。6.4 從仿真到臺(tái)架提前做好這三件事仿真里能跑通離臺(tái)架上能轉(zhuǎn)還差著好幾步。我總結(jié)三個(gè)最容易出問(wèn)題的地方第一逆變器死區(qū)和最小脈寬補(bǔ)償。仿真里的理想逆變器和真實(shí)的 PWM 逆變器不是一回事死區(qū)會(huì)引起電壓誤差高速時(shí)影響相對(duì)小但調(diào)試起步階段最好早做。第二電流傳感器零點(diǎn)偏移。零點(diǎn)稍微偏一點(diǎn)經(jīng)過(guò)低通和 PLL 之后就會(huì)變成位置估計(jì)的固定偏置。上電自檢階段就應(yīng)該把零點(diǎn)補(bǔ)償做掉。第三控制器一拍延遲。數(shù)字控制器里電流采樣、控制計(jì)算、PWM 更新不是一個(gè)周期內(nèi)瞬時(shí)完成的工程上普遍存在一拍延時(shí)。建議在電流環(huán)路徑里補(bǔ)一拍補(bǔ)償否則位置估計(jì)做再準(zhǔn)控制鏈路的整體滯后也會(huì)把性能拖下來(lái)。最后說(shuō)點(diǎn)個(gè)人體會(huì)。把仿真跑通只是第一步真正要在不同轉(zhuǎn)速、不同負(fù)載下都穩(wěn)得把三個(gè)東西時(shí)刻記住低通濾波的相位滯后、邊界層與切換增益的匹配、PLL 的動(dòng)態(tài)帶寬。我在復(fù)現(xiàn)這個(gè)優(yōu)化滑模觀(guān)測(cè)器的過(guò)程中最有價(jià)值的收獲不是把抖振數(shù)值降了多少而是明白了“抖振”不是一個(gè)孤立現(xiàn)象它和位置提取、電流噪聲、離散延遲是一整套耦合關(guān)系。如果你正在做類(lèi)似的無(wú)感控制項(xiàng)目建議先把這幾個(gè)環(huán)節(jié)的滯后預(yù)算算清楚再調(diào)參數(shù)會(huì)少走不少?gòu)澛贰?