控制：從算法原理到工程實(shí)踐)
1. 項(xiàng)目概述當(dāng)MCX A MCU遇上無感FOC最近在做一個(gè)挺有意思的項(xiàng)目核心就是用恩智浦NXP新出的MCX A系列微控制器MCU去驅(qū)動(dòng)一臺(tái)永磁同步電機(jī)PMSM而且用的是無位置傳感器Sensorless的磁場定向控制FOC算法。這聽起來像是把幾個(gè)熱門技術(shù)詞堆在了一起但實(shí)際做下來你會(huì)發(fā)現(xiàn)這恰恰是當(dāng)前電機(jī)控制領(lǐng)域一個(gè)非常典型且富有挑戰(zhàn)性的應(yīng)用場景。簡單來說就是如何在不安裝任何物理位置傳感器如編碼器、旋變的情況下讓一臺(tái)PMSM電機(jī)平穩(wěn)、高效、高動(dòng)態(tài)地轉(zhuǎn)起來并且把這一切都塞進(jìn)一顆性價(jià)比不錯(cuò)的通用MCU里。為什么這個(gè)組合值得關(guān)注首先PMSM電機(jī)本身效率高、功率密度大、控制性能好在無人機(jī)、電動(dòng)工具、家電、工業(yè)泵和風(fēng)機(jī)里應(yīng)用越來越廣。但傳統(tǒng)的PMSM驅(qū)動(dòng)需要位置傳感器來告訴控制器轉(zhuǎn)子在哪這增加了成本、體積和潛在的故障點(diǎn)。無感FOC技術(shù)就是為了去掉這個(gè)傳感器通過算法“猜”出轉(zhuǎn)子位置實(shí)現(xiàn)降本增效。而MCX A系列MCU作為NXP面向工業(yè)和物聯(lián)網(wǎng)推出的新一代產(chǎn)品集成了高性能的Arm Cortex-M33內(nèi)核、豐富的模擬外設(shè)和加速器正好為這種對(duì)算力和實(shí)時(shí)性要求苛刻的算法提供了一個(gè)理想的硬件平臺(tái)。這個(gè)項(xiàng)目本質(zhì)上就是在探索這顆MCU的潛力邊界驗(yàn)證一套低成本、高性能的無感PMSM驅(qū)動(dòng)方案。如果你正在從事電機(jī)驅(qū)動(dòng)開發(fā)或者對(duì)如何將先進(jìn)的算法落地到實(shí)際的MCU平臺(tái)感興趣那么接下來的內(nèi)容應(yīng)該能給你一些直接的參考。我會(huì)從整體方案設(shè)計(jì)、核心算法實(shí)現(xiàn)、在MCX A上的具體移植與優(yōu)化再到調(diào)試中踩過的那些坑逐一拆開來講。目標(biāo)很明確讓你不僅能看懂還能動(dòng)手復(fù)現(xiàn)。2. 無感FOC方案的整體設(shè)計(jì)與核心思路無感FOC不是一個(gè)新概念但它的實(shí)現(xiàn)方案一直在演進(jìn)。在做這個(gè)基于MCX A的項(xiàng)目時(shí)我首先需要確定一個(gè)技術(shù)路線。市面上主流的方法大概有幾類基于反電動(dòng)勢Back-EMF觀測器的比如滑模觀測器SMO、龍貝格觀測器、模型參考自適應(yīng)MRAS、基于高頻信號(hào)注入的以及一些新興的AI方法。對(duì)于我這個(gè)面向通用變頻、風(fēng)機(jī)水泵等中高速應(yīng)用的項(xiàng)目基于反電動(dòng)勢的觀測器方法是最成熟、最實(shí)用的選擇因?yàn)樗灰蕾囯姍C(jī)凸極性在中高速區(qū)性能非常可靠。我最終選擇了滑模觀測器SMO結(jié)合鎖相環(huán)PLL的方案來估算轉(zhuǎn)子位置和速度。為什么是它首先SMO結(jié)構(gòu)相對(duì)簡單對(duì)參數(shù)變化的魯棒性強(qiáng)這在批量生產(chǎn)時(shí)是個(gè)巨大優(yōu)勢你不需要為每臺(tái)電機(jī)做極其精細(xì)的參數(shù)辨識(shí)。其次它的動(dòng)態(tài)響應(yīng)快能很好地跟蹤速度變化。最后結(jié)合PLL進(jìn)行位置和速度提取可以有效濾除觀測器輸出中的高頻抖振噪聲得到平滑的估計(jì)值。這套組合拳在工業(yè)界經(jīng)過了大量驗(yàn)證是性價(jià)比很高的選擇。整個(gè)系統(tǒng)的控制框圖在心里和代碼里應(yīng)該是這樣的采集電機(jī)的三相電流Ia, Ib, Ic和直流母線電壓Udc。通過克拉克變換Clarke Transform和帕克變換Park Transform將靜止坐標(biāo)系下的三相電流轉(zhuǎn)換到隨轉(zhuǎn)子磁場同步旋轉(zhuǎn)的d-q坐標(biāo)系下。在這個(gè)坐標(biāo)系里電流被分解為產(chǎn)生磁場的勵(lì)磁分量Id和產(chǎn)生轉(zhuǎn)矩的交軸分量Iq。我們的控制目標(biāo)就是讓Id跟隨給定值通常設(shè)為零用于弱磁控制或最大轉(zhuǎn)矩電流比控制讓Iq跟隨轉(zhuǎn)矩指令?？刂破鞯妮敵鍪莇-q坐標(biāo)系下的電壓指令Vd和Vq再經(jīng)過反帕克變換和空間矢量脈寬調(diào)制SVPWM生成六路PWM波去驅(qū)動(dòng)三相逆變橋從而控制電機(jī)。而這一切的“眼睛”——轉(zhuǎn)子位置信息就來自于那個(gè)無感的“猜”。SMO會(huì)利用采集到的電流和施加的電壓構(gòu)建一個(gè)電機(jī)數(shù)學(xué)模型并不斷比較模型輸出的電流估計(jì)值和實(shí)際采樣值之間的誤差。通過一個(gè)滑模控制律強(qiáng)迫這個(gè)誤差趨向于零在這個(gè)過程中觀測器內(nèi)部的一個(gè)狀態(tài)量就會(huì)收斂到與反電動(dòng)勢相關(guān)的信息上。我們?cè)購倪@個(gè)信息中提取出轉(zhuǎn)子的電角度和轉(zhuǎn)速。這個(gè)估算出的角度反過來提供給帕克/反帕克變換使用形成一個(gè)閉環(huán)。聽起來有點(diǎn)“雞生蛋、蛋生雞”的循環(huán)依賴所以啟動(dòng)階段需要特殊處理這是后話。注意方案選型沒有絕對(duì)的好壞只有是否合適。如果你的應(yīng)用要求極低速甚至零速帶載啟動(dòng)如直接驅(qū)動(dòng)的洗衣機(jī)滾筒那么高頻注入法可能是必須的但它算法更復(fù)雜對(duì)CPU和采樣要求也更高。對(duì)于大多數(shù)從幾百RPM開始運(yùn)行的應(yīng)用SMOPLL是完全夠用的。3. 核心算法模塊的深度解析與實(shí)現(xiàn)要點(diǎn)確定了SMOPLL的路線接下來就得把每個(gè)算法模塊掰開揉碎理解其數(shù)學(xué)本質(zhì)和在MCU里實(shí)現(xiàn)的細(xì)節(jié)。這部分的代碼寫得好不好直接決定了整個(gè)系統(tǒng)是“跑起來”還是“轉(zhuǎn)得好”。3.1 電流采樣與坐標(biāo)變換的“基石”作用一切始于精確的電流采樣。我使用的是最經(jīng)典的雙電阻采樣方案即在逆變橋的下橋臂串聯(lián)兩個(gè)采樣電阻測量其中兩相電流通常是Ia和Ib第三相電流通過Ic -Ia - Ib計(jì)算得出。MCX A的ADC模塊支持同步觸發(fā)采樣這至關(guān)重要。我必須將ADC的采樣時(shí)刻精確地安排在PWM計(jì)數(shù)器的特定點(diǎn)通常是下橋臂導(dǎo)通的中點(diǎn)或PWM周期中心以避開開關(guān)噪聲。MCX A的交叉開關(guān)Crossbar和定時(shí)器聯(lián)動(dòng)功能讓這個(gè)配置變得直觀。采回來的電流值是帶偏置的需要先進(jìn)行軟件或硬件上的偏移校準(zhǔn)。然后進(jìn)行克拉克變換將三相靜止坐標(biāo)系a-b-c變換到兩相靜止坐標(biāo)系α-β。這個(gè)變換的目的是消除三相之間的耦合降低系統(tǒng)階數(shù)。公式很簡單但要注意系數(shù)的處理是使用等幅值變換還是等功率變換我選擇了等幅值變換因?yàn)樗Ｒ娗液罄m(xù)處理方便。// 示例克拉克變換 (等幅值變換) // Ia, Ib 為采樣并校準(zhǔn)后的相電流 I_alpha Ia; I_beta (Ia 2.0f * Ib) * ONE_BY_SQRT3; // 注意浮點(diǎn)運(yùn)算效率后續(xù)會(huì)優(yōu)化帕克變換則是將靜止的α-β坐標(biāo)系變換到旋轉(zhuǎn)的d-q坐標(biāo)系變換的角度就是估算的轉(zhuǎn)子電角度θ。這是FOC的核心因?yàn)樗鼘?shí)現(xiàn)了對(duì)勵(lì)磁電流和轉(zhuǎn)矩電流的解耦控制。在MCU中這需要頻繁計(jì)算sinθ和cosθ。直接調(diào)用標(biāo)準(zhǔn)庫的sinf()和cosf()函數(shù)在中斷里是災(zāi)難性的會(huì)嚴(yán)重消耗CPU周期。因此我通常采用查表法結(jié)合線性插值或者使用Cordic算法硬件協(xié)處理器如果MCU支持。MCX A的Cortex-M33內(nèi)核有浮點(diǎn)單元但對(duì)于實(shí)時(shí)性要求極高的中斷服務(wù)程序查表法仍然是更穩(wěn)妥的選擇。3.2 滑模觀測器SMO的設(shè)計(jì)與參數(shù)整定SMO是整個(gè)無感系統(tǒng)的“心臟”。其核心思想是為電機(jī)電流模型設(shè)計(jì)一個(gè)非線性反饋迫使觀測器狀態(tài)跟蹤實(shí)際系統(tǒng)狀態(tài)。我采用的是一種基于反電動(dòng)勢估算的簡化SMO模型。觀測器的狀態(tài)方程基于PMSM在α-β坐標(biāo)系下的電壓方程。我們構(gòu)建一個(gè)電流觀測器其輸入是施加的電壓Vα, Vβ和滑?？刂祈?xiàng)Zα, Zβ?；？刂祈?xiàng)是一個(gè)開關(guān)函數(shù)通常用符號(hào)函數(shù)sign()或飽和函數(shù)sat()來實(shí)現(xiàn)后者可以減輕高頻抖振。// 簡化的SMO離散化實(shí)現(xiàn)示意 // 計(jì)算電流誤差 e_alpha I_alpha_hat - I_alpha_measured; e_beta I_beta_hat - I_beta_measured; // 滑?？刂屏?(使用飽和函數(shù)代替符號(hào)函數(shù)以減少抖振) Z_alpha -K_slide * sat(e_alpha, boundary); Z_beta -K_slide * sat(e_beta, boundary); // 觀測器狀態(tài)更新 (前向歐拉法離散化) I_alpha_hat Ts * ( -Rs/Ls * I_alpha_hat We_hat * I_beta_hat (V_alpha - Z_alpha)/Ls ); I_beta_hat Ts * ( -Rs/Ls * I_beta_hat - We_hat * I_alpha_hat (V_beta - Z_beta)/Ls ); // 反電動(dòng)勢估算值 E_alpha_est Z_alpha; E_beta_est Z_beta;這里的關(guān)鍵參數(shù)是滑模增益K_slide和飽和函數(shù)的邊界值boundary。K_slide需要足夠大以保證系統(tǒng)滿足滑?？蛇_(dá)條件但太大會(huì)加劇抖振和噪聲。boundary的選擇則是在響應(yīng)速度和平滑度之間做權(quán)衡。通常需要根據(jù)電機(jī)參數(shù)Rs, Ls和電氣時(shí)間常數(shù)進(jìn)行初步計(jì)算然后通過實(shí)驗(yàn)微調(diào)。我的經(jīng)驗(yàn)是先從理論值的0.5倍開始觀察估算反電動(dòng)勢的波形調(diào)整到既有快速跟蹤能力波形又相對(duì)干凈的狀態(tài)。3.3 鎖相環(huán)PLL提取角度與速度SMO輸出的是包含位置信息的反電動(dòng)勢分量Eα和Eβ。我們需要從中提取出平滑的轉(zhuǎn)子角度θ和電角速度ωe。一個(gè)基于反正切函數(shù)的PLL是標(biāo)準(zhǔn)做法。PLL的原理是先通過反正切函數(shù)atan2(-E_alpha, E_beta)得到一個(gè)粗略的、可能包含噪聲的位置信號(hào)θ_raw。但這個(gè)信號(hào)是跳變的在-π到π之間。PLL內(nèi)部有一個(gè)相位檢測器比較估算角度θ_est和粗略角度θ_raw的差值將這個(gè)差值通過一個(gè)PI調(diào)節(jié)器其輸出就是估算的電角速度ωe_est。再將這個(gè)速度積分就得到了平滑后的估算角度θ_est。// PLL實(shí)現(xiàn)核心 theta_raw atan2f(-E_alpha_est, E_beta_est); // 注意象限處理atan2返回值在[-pi, pi] // 處理角度卷繞使theta_raw連續(xù) theta_raw unwrap(theta_raw, prev_theta_raw); phase_error theta_raw - theta_est; // PI調(diào)節(jié)器處理相位誤差輸出為估算電速度 omega_est pll_kp * phase_error pll_ki * pll_integral; pll_integral phase_error * Ts; // 積分項(xiàng) // 積分得到平滑角度 theta_est omega_est * Ts;PLL參數(shù)pll_kp和pll_ki的整定至關(guān)重要。pll_kp決定了跟蹤速度pll_ki用于消除靜態(tài)誤差。我的調(diào)試步驟是先將pll_ki設(shè)為0逐漸增大pll_kp直到系統(tǒng)能夠快速鎖定但又不產(chǎn)生超調(diào)振蕩然后加入較小的pll_ki以消除穩(wěn)態(tài)誤差。這個(gè)過程需要在電機(jī)不同轉(zhuǎn)速下反復(fù)驗(yàn)證。實(shí)操心得在啟動(dòng)和極低速時(shí)反電動(dòng)勢信號(hào)很弱SMO和PLL可能無法正常工作。因此無感FOC必須包含一個(gè)獨(dú)立的“啟動(dòng)與低速運(yùn)行”策略。我采用的是“開環(huán)啟動(dòng)”“切換”策略。先以預(yù)設(shè)的V/f曲線即I-F控制將電機(jī)拖到一定速度例如10%額定轉(zhuǎn)速產(chǎn)生足夠強(qiáng)的反電動(dòng)勢后再平滑地將控制權(quán)交給基于SMO的閉環(huán)FOC。這個(gè)切換點(diǎn)的判斷和切換過程的平滑性是算法穩(wěn)定性的關(guān)鍵需要仔細(xì)設(shè)計(jì)滯回比較和漸變過渡邏輯。4. 在MCX A MCU上的工程實(shí)現(xiàn)與優(yōu)化算法理論通了下一步就是把它塞進(jìn)MCX A這顆MCU里并讓它高效、穩(wěn)定地跑起來。這涉及到外設(shè)配置、實(shí)時(shí)性保障和性能優(yōu)化。4.1 關(guān)鍵外設(shè)配置與初始化MCX A系列通常配備多個(gè)高級(jí)定時(shí)器、高精度ADC和豐富的通信接口。我的配置核心圍繞以下幾點(diǎn)PWM定時(shí)器用于生成SVPWM。我使用一個(gè)通用定時(shí)器如CTIMER的中心對(duì)齊模式產(chǎn)生六路帶死區(qū)互補(bǔ)的PWM輸出。死區(qū)時(shí)間必須根據(jù)所使用的功率器件IGBT或MOSFET的開關(guān)特性謹(jǐn)慎設(shè)置通常通過定時(shí)器的死區(qū)插入功能硬件實(shí)現(xiàn)這比軟件模擬更可靠。PWM頻率開關(guān)頻率我設(shè)置為16kHz這是一個(gè)在開關(guān)損耗、電流紋波和CPU計(jì)算負(fù)擔(dān)之間較好的折中點(diǎn)。MCX的定時(shí)器支持影子寄存器可以在一個(gè)PWM周期結(jié)束后自動(dòng)更新占空比避免中間切換產(chǎn)生毛刺。ADC用于電流和電壓采樣。配置兩個(gè)ADC模塊或一個(gè)ADC的兩個(gè)通道在PWM定時(shí)器的特定觸發(fā)事件如計(jì)數(shù)器下溢或中點(diǎn)同步啟動(dòng)采樣。必須啟用DMA將采樣結(jié)果直接搬運(yùn)到內(nèi)存中的指定數(shù)組避免CPU干預(yù)。ADC的采樣精度和速度要足夠12位分辨率、1Msps以上采樣率是基本要求。還需要配置好模擬輸入通道的引腳復(fù)用。時(shí)鐘系統(tǒng)確保CPU主頻、定時(shí)器時(shí)鐘和ADC時(shí)鐘都設(shè)置正確且穩(wěn)定。MCX A可能支持多種時(shí)鐘源內(nèi)部IRC、外部晶振、PLL我通常使用外部晶振通過PLL倍頻得到系統(tǒng)主頻以保證定時(shí)和采樣的長期穩(wěn)定性。GPIO與保護(hù)將PWM輸出引腳配置為高驅(qū)動(dòng)能力模式。一定要配置硬件過流保護(hù)如果MCU支持或至少用高速比較器配合GPIO中斷實(shí)現(xiàn)軟件保護(hù)。故障安全引腳如MCU的_FB_引腳要正確連接確保在過流時(shí)能硬件封鎖PWM輸出。4.2 軟件架構(gòu)與中斷服務(wù)程序設(shè)計(jì)無感FOC是一個(gè)強(qiáng)實(shí)時(shí)系統(tǒng)必須采用中斷驅(qū)動(dòng)。我的軟件架構(gòu)如下主循環(huán)負(fù)責(zé)非實(shí)時(shí)任務(wù)如通訊UART/CAN接收指令、發(fā)送狀態(tài)、狀態(tài)機(jī)管理啟動(dòng)、運(yùn)行、故障、停止、參數(shù)讀寫、上位機(jī)調(diào)試接口等。高優(yōu)先級(jí)中斷如PWM周期中斷這是FOC算法的核心執(zhí)行地。中斷頻率等于PWM頻率16kHz。在這個(gè)中斷服務(wù)程序ISR里必須順序完成以下操作讀取DMA搬運(yùn)過來的最新電流、電壓ADC值。執(zhí)行電流坐標(biāo)變換Clarke, Park。運(yùn)行電流環(huán)PI調(diào)節(jié)器產(chǎn)生Vd, Vq。執(zhí)行滑模觀測器SMO和鎖相環(huán)PLL估算角度和速度。執(zhí)行速度環(huán)PI調(diào)節(jié)器如果需要閉環(huán)速度控制。進(jìn)行反Park變換和SVPWM計(jì)算更新下一個(gè)PWM周期的比較寄存器值。低優(yōu)先級(jí)中斷用于處理過流故障、編碼器接口如果有、通訊接收等。關(guān)鍵優(yōu)化點(diǎn)ISR內(nèi)禁用浮點(diǎn)盡管MCX A有FPU但在16kHz的中斷里進(jìn)行大量浮點(diǎn)運(yùn)算仍可能吃滿CPU。我將所有核心算法坐標(biāo)變換、PI、SMO、PLL全部用定點(diǎn)數(shù)Q格式實(shí)現(xiàn)。例如使用Q15或Q31格式表示小數(shù)用整數(shù)乘法和移位代替浮點(diǎn)運(yùn)算速度能提升數(shù)倍。這是保證在高開關(guān)頻率下仍有足夠時(shí)間裕度的關(guān)鍵。查表法對(duì)于sin/cos、反正切等復(fù)雜函數(shù)使用預(yù)先計(jì)算好的查找表。對(duì)于角度將360度分為512或1024份存儲(chǔ)對(duì)應(yīng)的sin和cos值。對(duì)于atan2可以使用簡化算法或分段線性逼近而不是調(diào)用庫函數(shù)。充分利用硬件檢查MCX A是否有三角函數(shù)加速單元Cordic、濾波器協(xié)處理器等如果有務(wù)必用上能極大減輕CPU負(fù)擔(dān)。變量范圍與標(biāo)幺化將電流、電壓、角度等物理量進(jìn)行標(biāo)幺化處理使其落在[-1, 1]或[0, 1]范圍內(nèi)便于定點(diǎn)數(shù)處理和參數(shù)整定。4.3 SVPWM模塊的實(shí)現(xiàn)細(xì)節(jié)空間矢量脈寬調(diào)制SVPWM是提高直流母線電壓利用率和降低諧波的關(guān)鍵。其實(shí)現(xiàn)步驟固定根據(jù)Vα和Vβ由Vd, Vq經(jīng)反Park變換得到判斷所在的扇區(qū)。計(jì)算相鄰兩個(gè)基本電壓矢量的作用時(shí)間T1, T2。根據(jù)扇區(qū)計(jì)算三相PWM比較值Ta, Tb, Tc?？紤]死區(qū)時(shí)間最終設(shè)置定時(shí)器的比較寄存器。在MCU中需要特別注意計(jì)算過程中的溢出和邊界檢查。例如T1T2不能超過一個(gè)PWM周期。我通常會(huì)將計(jì)算出的時(shí)間轉(zhuǎn)換為定時(shí)器計(jì)數(shù)器的值并在賦值前進(jìn)行限幅。// 簡化的SVPWM扇區(qū)判斷和時(shí)間計(jì)算偽代碼 v_alpha ...; // 反Park變換得到 v_beta ...; // 扇區(qū)判斷 if (v_beta 0) { if (v_alpha 0) { if (v_beta * SQRT3 v_alpha) sector 1; else sector 2; } else { if (v_beta * SQRT3 -v_alpha) sector 3; else sector 4; } } else { // ... 類似邏輯判斷扇區(qū)5,6,1,2 } // 根據(jù)扇區(qū)計(jì)算X, Y, Z和時(shí)間T1, T2 // ... // 計(jì)算占空比 t_a (PWM_PERIOD - T1 - T2) / 2; t_b t_a T1; t_c t_b T2; // 根據(jù)扇區(qū)映射到實(shí)際的U, V, W相 // ... // 設(shè)置比較寄存器注意減去死區(qū)時(shí)間5. 調(diào)試過程、問題排查與參數(shù)整定實(shí)錄理論完美代碼寫完一上電電機(jī)可能紋絲不動(dòng)或者瘋狂抖動(dòng)。這才是真正工作的開始。調(diào)試無感FOC是一個(gè)系統(tǒng)工程需要清晰的步驟和耐心。5.1 分步調(diào)試法從開環(huán)到閉環(huán)絕對(duì)不要試圖一上來就運(yùn)行完整的無感FOC閉環(huán)。必須分步驗(yàn)證硬件與基礎(chǔ)外設(shè)測試不接電機(jī)用示波器觀察六路PWM輸出波形確認(rèn)死區(qū)正確占空比可調(diào)。測試ADC采樣注入已知電壓看讀取值是否正確。開環(huán)V/F控制測試這是驗(yàn)證功率電路和基本控制邏輯的第一步。讓電機(jī)在開環(huán)下勻速旋轉(zhuǎn)用電流鉗觀察三相電流是否為正弦波且平衡。同時(shí)可以驗(yàn)證坐標(biāo)變換是否正確在開環(huán)旋轉(zhuǎn)時(shí)手動(dòng)將估算角度設(shè)為真實(shí)角度如果裝有編碼器或設(shè)為開環(huán)給定的角度然后觀察d-q軸電流。在理想情況下Iq應(yīng)該接近轉(zhuǎn)矩電流指令I(lǐng)d應(yīng)該接近0。如果Id很大說明變換角度有誤。電流環(huán)調(diào)試在開環(huán)旋轉(zhuǎn)的基礎(chǔ)上將速度環(huán)打開但設(shè)為0讓電機(jī)靜止在某個(gè)位置需要編碼器或強(qiáng)制給一個(gè)固定角度。然后注入一個(gè)階躍的Iq指令觀察Iq的響應(yīng)。調(diào)整電流環(huán)PI參數(shù)先P后I目標(biāo)是響應(yīng)快速且無超調(diào)。這一步需要在多個(gè)不同的電角度下重復(fù)以驗(yàn)證電流解耦的效果。觀測器與PLL調(diào)試關(guān)鍵在開環(huán)旋轉(zhuǎn)狀態(tài)下將觀測器估算的角度和速度輸出與開環(huán)給定的角度和速度進(jìn)行比較。調(diào)整SMO的滑模增益和PLL的PI參數(shù)使估算值能快速、平穩(wěn)地跟蹤給定值。此時(shí)可以暫時(shí)不將估算角度用于反饋。閉環(huán)切換當(dāng)觀測器在開環(huán)狀態(tài)下能穩(wěn)定跟蹤后嘗試進(jìn)行開環(huán)到閉環(huán)的切換。切換邏輯要柔和例如在切換瞬間將閉環(huán)的電流環(huán)輸出與開環(huán)的電壓指令進(jìn)行加權(quán)混合逐漸過渡。密切觀察切換瞬間的電流和速度是否平穩(wěn)。5.2 常見問題與排查技巧以下是我在調(diào)試MCX A無感FOC項(xiàng)目中遇到的一些典型問題及解決方法問題現(xiàn)象可能原因排查思路與解決方法電機(jī)不轉(zhuǎn)或輕微抖動(dòng)后停住1. 電機(jī)相序接反。2. PWM死區(qū)時(shí)間過長或過短。3. 電流采樣極性錯(cuò)誤或偏移未校準(zhǔn)。4. 觀測器未收斂估算角度錯(cuò)誤。1. 任意交換兩相電機(jī)線或修改軟件相序映射。2. 用示波器測量上下橋臂驅(qū)動(dòng)波形確保有死區(qū)且無重疊。根據(jù)器件手冊(cè)調(diào)整死區(qū)時(shí)間。3. 電機(jī)靜止時(shí)讀取三相ADC值應(yīng)為0附近。施加一個(gè)小的電壓矢量觀察電流采樣值變化方向是否正確。4. 在開環(huán)模式下對(duì)比給定角度和估算角度波形。檢查SMO和PLL參數(shù)是否過于激進(jìn)或保守。電機(jī)旋轉(zhuǎn)但噪音大、振動(dòng)劇烈1. 電流環(huán)PI參數(shù)不合適通常是積分過大或比例過大。2. PWM開關(guān)頻率過低電流紋波大。3. 觀測器估算的角度有高頻噪聲。4. SVPWM計(jì)算中存在數(shù)值溢出或錯(cuò)誤。1. 重新整定電流環(huán)優(yōu)先保證穩(wěn)定再求快速?？蓵簳r(shí)將積分項(xiàng)設(shè)為零調(diào)試。2. 適當(dāng)提高PWM頻率如從8k提到16k或20k注意評(píng)估開關(guān)損耗和MCU計(jì)算能力。3. 檢查PLL的帶寬降低PLL的pll_kp增益增加濾波。檢查SMO輸出的反電動(dòng)勢信號(hào)是否干凈。4. 檢查SVPWM計(jì)算中的變量范圍特別是作用時(shí)間T1、T2確保其和不超過PWM周期。中高速運(yùn)行正常但啟動(dòng)困難或低速抖動(dòng)1. 開環(huán)啟動(dòng)階段參數(shù)V/F曲線不合適。2. 開環(huán)到閉環(huán)的切換點(diǎn)設(shè)置不當(dāng)。3. 低速時(shí)反電動(dòng)勢信號(hào)弱觀測器信噪比低。1. 調(diào)整開環(huán)啟動(dòng)的電壓提升IR補(bǔ)償和頻率斜坡斜率確保有足夠的啟動(dòng)力矩。2. 延遲切換點(diǎn)確保電機(jī)在更高速度下再切入閉環(huán)。設(shè)計(jì)平滑的切換過渡算法。3. 考慮在低速區(qū)使用I-F控制電流-頻率控制作為過渡或者嘗試更先進(jìn)的觀測器如自適應(yīng)觀測器以提升低速性能。帶載能力差稍加負(fù)載就失步1. 電流環(huán)帶寬不足動(dòng)態(tài)響應(yīng)慢。2. 速度環(huán)PI參數(shù)未整定好。3. 直流母線電壓不足或母線電容太小。4. 電機(jī)參數(shù)Rs, Ls, Flux不準(zhǔn)確特別是轉(zhuǎn)子磁鏈。1. 在安全范圍內(nèi)增大電流環(huán)比例增益或檢查ADC采樣和計(jì)算延時(shí)是否過大。2. 閉環(huán)速度模式下重新整定速度環(huán)PI參數(shù)。3. 檢查電源增大母線電容以穩(wěn)定電壓。4. 進(jìn)行電機(jī)參數(shù)辨識(shí)。Rs可通過直流注入法測量Ls和Flux可通過特定測試流程或在線辨識(shí)算法獲得。更新控制器中的電機(jī)參數(shù)。估算角度與真實(shí)角度存在固定偏差1. 電流采樣通道的相位延遲不一致。2. 軟件計(jì)算中的角度補(bǔ)償不準(zhǔn)確。3. PWM更新時(shí)刻與ADC采樣時(shí)刻不匹配。1. 檢查ADC采樣保持時(shí)間和信號(hào)調(diào)理電路的相位特性確保三相一致。2. 在已知正確角度如編碼器的情況下測量偏差值在軟件中增加一個(gè)固定的角度補(bǔ)償offset。3. 精確計(jì)算從PWM更新到ADC采樣到算法執(zhí)行完畢的整個(gè)延時(shí)并在角度估算中進(jìn)行超前補(bǔ)償。5.3 參數(shù)整定的經(jīng)驗(yàn)法則電流環(huán)帶寬通常設(shè)為開關(guān)頻率的1/10到1/5。先設(shè)Ki0增大Kp直到系統(tǒng)出現(xiàn)輕微振蕩然后取該值的60%~70%。再引入較小的Ki以消除靜差。速度環(huán)帶寬應(yīng)遠(yuǎn)低于電流環(huán)通常低一個(gè)數(shù)量級(jí)。整定方法類似但更注重抗負(fù)載擾動(dòng)的能力。SMO滑模增益與反電動(dòng)勢幅值相關(guān)?？梢韵雀鶕?jù)電機(jī)額定反電動(dòng)勢和母線電壓估算一個(gè)值然后以電機(jī)額定速度的20%運(yùn)行觀察估算反電動(dòng)勢波形調(diào)整增益使其波形清晰且噪聲可接受。PLL參數(shù)pll_kp決定了跟蹤帶寬?？梢栽O(shè)置為期望的動(dòng)態(tài)響應(yīng)速度對(duì)應(yīng)的頻率如100Hz的2π倍作為初值。pll_ki設(shè)為pll_kp的1/10到1/100用于消除穩(wěn)態(tài)誤差。調(diào)試過程中一個(gè)強(qiáng)大的上位機(jī)工具至關(guān)重要。我通常會(huì)通過MCU的串口或CAN實(shí)時(shí)將關(guān)鍵變量如Id, Iq, 估算角度 真實(shí)角度 速度指令 速度反饋等發(fā)送到電腦用類似MATLAB或自定義的QT/Python工具繪制波形。圖形化的對(duì)比能讓你瞬間定位問題所在。6. 性能優(yōu)化與進(jìn)階考量當(dāng)基本功能跑通后就可以考慮進(jìn)一步優(yōu)化性能和擴(kuò)展功能了。6.1 利用MCX A的特定硬件加速M(fèi)CX A系列可能集成了一些能顯著提升FOC性能的模塊三角函數(shù)單元Cordic如果存在務(wù)必用它來加速sin、cos、atan2的計(jì)算能節(jié)省大量CPU周期?？删幊踢壿媶卧鏟LC或PFA一些MCU內(nèi)置了小規(guī)模FPGA或可編程邏輯陣列。可以考慮將SVPWM生成、ADC觸發(fā)邏輯甚至簡單的保護(hù)功能下放到硬件中實(shí)現(xiàn)進(jìn)一步解放CPU。硬件除法器和乘加單元確保編譯器優(yōu)化選項(xiàng)開啟充分利用這些單元進(jìn)行定點(diǎn)數(shù)運(yùn)算。內(nèi)存加速器如Cache將頻繁訪問的數(shù)據(jù)如sin/cos表、PI控制器結(jié)構(gòu)體放到TCM或帶Cache的內(nèi)存區(qū)域減少訪問延遲。6.2 增加魯棒性與可靠性功能一個(gè)工業(yè)級(jí)的產(chǎn)品不能只停留在“能轉(zhuǎn)”參數(shù)在線辨識(shí)電機(jī)參數(shù)Rs, Ls會(huì)隨溫度變化?？梢詫?shí)現(xiàn)在線辨識(shí)算法在電機(jī)運(yùn)行于特定狀態(tài)時(shí)自動(dòng)更新參數(shù)提升控制精度。故障診斷與保護(hù)完善過流、過壓、欠壓、過熱、堵轉(zhuǎn)、失速等故障檢測與保護(hù)邏輯。MCX A的模擬比較器和PWM故障輸入引腳要充分利用。弱磁控制當(dāng)電機(jī)轉(zhuǎn)速超過基速時(shí)需要注入負(fù)的Id電流來削弱磁場以實(shí)現(xiàn)更高轉(zhuǎn)速的運(yùn)行。這需要擴(kuò)展電流環(huán)的指令生成邏輯。能耗制動(dòng)在快速減速或大慣量負(fù)載時(shí)需要將再生能量消耗在制動(dòng)電阻上這涉及到對(duì)母線電壓的監(jiān)控和制動(dòng)IGBT的控制。6.3 與開發(fā)工具的配合以J-Flash為例在開發(fā)過程中可能會(huì)遇到像“J-Flash里面沒有所需要的MCU型號(hào)”這樣的工具鏈問題。這很常見尤其是對(duì)于像MCX A這樣的新系列MCU。我的解決思路是檢查J-Flash版本確保你使用的是最新版本的J-Flash軟件Segger會(huì)定期更新設(shè)備支持包。手動(dòng)安裝設(shè)備支持包前往MCU廠商N(yùn)XP的官網(wǎng)或Segger官網(wǎng)查找并下載對(duì)應(yīng)MCU系列的J-Flash設(shè)備支持包Device Family Pack DFP然后按照說明手動(dòng)安裝到J-Flash的安裝目錄下。使用通用配置文件如果官方?jīng)]有提供有時(shí)可以找一個(gè)內(nèi)核相同如Cortex-M33、Flash大小和地址映射相似的現(xiàn)有型號(hào)的配置文件然后手動(dòng)修改其Flash編程算法和內(nèi)存映射文件。但這需要你對(duì)MCU的存儲(chǔ)架構(gòu)和J-Flash的配置文件格式有較深了解風(fēng)險(xiǎn)較高。換用廠商官方工具很多時(shí)候MCU廠商自己的編程/調(diào)試工具如NXP的MCUXpresso IDE自帶的調(diào)試器對(duì)新芯片的支持是最快的?？梢韵扔霉俜焦ぞ哌M(jìn)行燒錄和調(diào)試等待第三方工具更新。最后我想說的是無感FOC在MCX A這類現(xiàn)代MCU上的實(shí)現(xiàn)已經(jīng)不再是遙不可及的黑科技。它是一系列經(jīng)典控制理論、數(shù)字信號(hào)處理技術(shù)和嵌入式工程實(shí)踐的有機(jī)結(jié)合。這個(gè)項(xiàng)目的成功關(guān)鍵在于對(duì)每個(gè)模塊原理的透徹理解、嚴(yán)謹(jǐn)?shù)墓こ虒?shí)現(xiàn)方法以及系統(tǒng)性的調(diào)試策略。從開環(huán)到閉環(huán)從空載到帶載每一步遇到的問題都是加深理解的契機(jī)。當(dāng)你第一次看到電機(jī)在無傳感器的情況下平穩(wěn)地跟隨速度指令變化時(shí)那種成就感是對(duì)所有調(diào)試煎熬的最好回報(bào)。希望這份基于實(shí)際項(xiàng)目的梳理能為你點(diǎn)亮這條路上的幾盞燈。 基于MCX A MCU的無感FOC電機(jī)控制：從算法原理到工程實(shí)踐
1. 項(xiàng)目概述當(dāng)MCX A MCU遇上無感FOC最近在做一個(gè)挺有意思的項(xiàng)目核心就是用恩智浦NXP新出的MCX A系列微控制器MCU去驅(qū)動(dòng)一臺(tái)永磁同步電機(jī)PMSM而且用的是無位置傳感器Sensorless的磁場定向控制FOC算法。這聽起來像是把幾個(gè)熱門技術(shù)詞堆在了一起但實(shí)際做下來你會(huì)發(fā)現(xiàn)這恰恰是當(dāng)前電機(jī)控制領(lǐng)域一個(gè)非常典型且富有挑戰(zhàn)性的應(yīng)用場景。簡單來說就是如何在不安裝任何物理位置傳感器如編碼器、旋變的情況下讓一臺(tái)PMSM電機(jī)平穩(wěn)、高效、高動(dòng)態(tài)地轉(zhuǎn)起來并且把這一切都塞進(jìn)一顆性價(jià)比不錯(cuò)的通用MCU里。為什么這個(gè)組合值得關(guān)注首先PMSM電機(jī)本身效率高、功率密度大、控制性能好在無人機(jī)、電動(dòng)工具、家電、工業(yè)泵和風(fēng)機(jī)里應(yīng)用越來越廣。但傳統(tǒng)的PMSM驅(qū)動(dòng)需要位置傳感器來告訴控制器轉(zhuǎn)子在哪這增加了成本、體積和潛在的故障點(diǎn)。無感FOC技術(shù)就是為了去掉這個(gè)傳感器通過算法“猜”出轉(zhuǎn)子位置實(shí)現(xiàn)降本增效。而MCX A系列MCU作為NXP面向工業(yè)和物聯(lián)網(wǎng)推出的新一代產(chǎn)品集成了高性能的Arm Cortex-M33內(nèi)核、豐富的模擬外設(shè)和加速器正好為這種對(duì)算力和實(shí)時(shí)性要求苛刻的算法提供了一個(gè)理想的硬件平臺(tái)。這個(gè)項(xiàng)目本質(zhì)上就是在探索這顆MCU的潛力邊界驗(yàn)證一套低成本、高性能的無感PMSM驅(qū)動(dòng)方案。如果你正在從事電機(jī)驅(qū)動(dòng)開發(fā)或者對(duì)如何將先進(jìn)的算法落地到實(shí)際的MCU平臺(tái)感興趣那么接下來的內(nèi)容應(yīng)該能給你一些直接的參考。我會(huì)從整體方案設(shè)計(jì)、核心算法實(shí)現(xiàn)、在MCX A上的具體移植與優(yōu)化再到調(diào)試中踩過的那些坑逐一拆開來講。目標(biāo)很明確讓你不僅能看懂還能動(dòng)手復(fù)現(xiàn)。2. 無感FOC方案的整體設(shè)計(jì)與核心思路無感FOC不是一個(gè)新概念但它的實(shí)現(xiàn)方案一直在演進(jìn)。在做這個(gè)基于MCX A的項(xiàng)目時(shí)我首先需要確定一個(gè)技術(shù)路線。市面上主流的方法大概有幾類基于反電動(dòng)勢Back-EMF觀測器的比如滑模觀測器SMO、龍貝格觀測器、模型參考自適應(yīng)MRAS、基于高頻信號(hào)注入的以及一些新興的AI方法。對(duì)于我這個(gè)面向通用變頻、風(fēng)機(jī)水泵等中高速應(yīng)用的項(xiàng)目基于反電動(dòng)勢的觀測器方法是最成熟、最實(shí)用的選擇因?yàn)樗灰蕾囯姍C(jī)凸極性在中高速區(qū)性能非常可靠。我最終選擇了滑模觀測器SMO結(jié)合鎖相環(huán)PLL的方案來估算轉(zhuǎn)子位置和速度。為什么是它首先SMO結(jié)構(gòu)相對(duì)簡單對(duì)參數(shù)變化的魯棒性強(qiáng)這在批量生產(chǎn)時(shí)是個(gè)巨大優(yōu)勢你不需要為每臺(tái)電機(jī)做極其精細(xì)的參數(shù)辨識(shí)。其次它的動(dòng)態(tài)響應(yīng)快能很好地跟蹤速度變化。最后結(jié)合PLL進(jìn)行位置和速度提取可以有效濾除觀測器輸出中的高頻抖振噪聲得到平滑的估計(jì)值。這套組合拳在工業(yè)界經(jīng)過了大量驗(yàn)證是性價(jià)比很高的選擇。整個(gè)系統(tǒng)的控制框圖在心里和代碼里應(yīng)該是這樣的采集電機(jī)的三相電流Ia, Ib, Ic和直流母線電壓Udc。通過克拉克變換Clarke Transform和帕克變換Park Transform將靜止坐標(biāo)系下的三相電流轉(zhuǎn)換到隨轉(zhuǎn)子磁場同步旋轉(zhuǎn)的d-q坐標(biāo)系下。在這個(gè)坐標(biāo)系里電流被分解為產(chǎn)生磁場的勵(lì)磁分量Id和產(chǎn)生轉(zhuǎn)矩的交軸分量Iq。我們的控制目標(biāo)就是讓Id跟隨給定值通常設(shè)為零用于弱磁控制或最大轉(zhuǎn)矩電流比控制讓Iq跟隨轉(zhuǎn)矩指令?？刂破鞯妮敵鍪莇-q坐標(biāo)系下的電壓指令Vd和Vq再經(jīng)過反帕克變換和空間矢量脈寬調(diào)制SVPWM生成六路PWM波去驅(qū)動(dòng)三相逆變橋從而控制電機(jī)。而這一切的“眼睛”——轉(zhuǎn)子位置信息就來自于那個(gè)無感的“猜”。SMO會(huì)利用采集到的電流和施加的電壓構(gòu)建一個(gè)電機(jī)數(shù)學(xué)模型并不斷比較模型輸出的電流估計(jì)值和實(shí)際采樣值之間的誤差。通過一個(gè)滑模控制律強(qiáng)迫這個(gè)誤差趨向于零在這個(gè)過程中觀測器內(nèi)部的一個(gè)狀態(tài)量就會(huì)收斂到與反電動(dòng)勢相關(guān)的信息上。我們?cè)購倪@個(gè)信息中提取出轉(zhuǎn)子的電角度和轉(zhuǎn)速。這個(gè)估算出的角度反過來提供給帕克/反帕克變換使用形成一個(gè)閉環(huán)。聽起來有點(diǎn)“雞生蛋、蛋生雞”的循環(huán)依賴所以啟動(dòng)階段需要特殊處理這是后話。注意方案選型沒有絕對(duì)的好壞只有是否合適。如果你的應(yīng)用要求極低速甚至零速帶載啟動(dòng)如直接驅(qū)動(dòng)的洗衣機(jī)滾筒那么高頻注入法可能是必須的但它算法更復(fù)雜對(duì)CPU和采樣要求也更高。對(duì)于大多數(shù)從幾百RPM開始運(yùn)行的應(yīng)用SMOPLL是完全夠用的。3. 核心算法模塊的深度解析與實(shí)現(xiàn)要點(diǎn)確定了SMOPLL的路線接下來就得把每個(gè)算法模塊掰開揉碎理解其數(shù)學(xué)本質(zhì)和在MCU里實(shí)現(xiàn)的細(xì)節(jié)。這部分的代碼寫得好不好直接決定了整個(gè)系統(tǒng)是“跑起來”還是“轉(zhuǎn)得好”。3.1 電流采樣與坐標(biāo)變換的“基石”作用一切始于精確的電流采樣。我使用的是最經(jīng)典的雙電阻采樣方案即在逆變橋的下橋臂串聯(lián)兩個(gè)采樣電阻測量其中兩相電流通常是Ia和Ib第三相電流通過Ic -Ia - Ib計(jì)算得出。MCX A的ADC模塊支持同步觸發(fā)采樣這至關(guān)重要。我必須將ADC的采樣時(shí)刻精確地安排在PWM計(jì)數(shù)器的特定點(diǎn)通常是下橋臂導(dǎo)通的中點(diǎn)或PWM周期中心以避開開關(guān)噪聲。MCX A的交叉開關(guān)Crossbar和定時(shí)器聯(lián)動(dòng)功能讓這個(gè)配置變得直觀。采回來的電流值是帶偏置的需要先進(jìn)行軟件或硬件上的偏移校準(zhǔn)。然后進(jìn)行克拉克變換將三相靜止坐標(biāo)系a-b-c變換到兩相靜止坐標(biāo)系α-β。這個(gè)變換的目的是消除三相之間的耦合降低系統(tǒng)階數(shù)。公式很簡單但要注意系數(shù)的處理是使用等幅值變換還是等功率變換我選擇了等幅值變換因?yàn)樗Ｒ娗液罄m(xù)處理方便。// 示例克拉克變換 (等幅值變換) // Ia, Ib 為采樣并校準(zhǔn)后的相電流 I_alpha Ia; I_beta (Ia 2.0f * Ib) * ONE_BY_SQRT3; // 注意浮點(diǎn)運(yùn)算效率后續(xù)會(huì)優(yōu)化帕克變換則是將靜止的α-β坐標(biāo)系變換到旋轉(zhuǎn)的d-q坐標(biāo)系變換的角度就是估算的轉(zhuǎn)子電角度θ。這是FOC的核心因?yàn)樗鼘?shí)現(xiàn)了對(duì)勵(lì)磁電流和轉(zhuǎn)矩電流的解耦控制。在MCU中這需要頻繁計(jì)算sinθ和cosθ。直接調(diào)用標(biāo)準(zhǔn)庫的sinf()和cosf()函數(shù)在中斷里是災(zāi)難性的會(huì)嚴(yán)重消耗CPU周期。因此我通常采用查表法結(jié)合線性插值或者使用Cordic算法硬件協(xié)處理器如果MCU支持。MCX A的Cortex-M33內(nèi)核有浮點(diǎn)單元但對(duì)于實(shí)時(shí)性要求極高的中斷服務(wù)程序查表法仍然是更穩(wěn)妥的選擇。3.2 滑模觀測器SMO的設(shè)計(jì)與參數(shù)整定SMO是整個(gè)無感系統(tǒng)的“心臟”。其核心思想是為電機(jī)電流模型設(shè)計(jì)一個(gè)非線性反饋迫使觀測器狀態(tài)跟蹤實(shí)際系統(tǒng)狀態(tài)。我采用的是一種基于反電動(dòng)勢估算的簡化SMO模型。觀測器的狀態(tài)方程基于PMSM在α-β坐標(biāo)系下的電壓方程。我們構(gòu)建一個(gè)電流觀測器其輸入是施加的電壓Vα, Vβ和滑?？刂祈?xiàng)Zα, Zβ?；？刂祈?xiàng)是一個(gè)開關(guān)函數(shù)通常用符號(hào)函數(shù)sign()或飽和函數(shù)sat()來實(shí)現(xiàn)后者可以減輕高頻抖振。// 簡化的SMO離散化實(shí)現(xiàn)示意 // 計(jì)算電流誤差 e_alpha I_alpha_hat - I_alpha_measured; e_beta I_beta_hat - I_beta_measured; // 滑?？刂屏?(使用飽和函數(shù)代替符號(hào)函數(shù)以減少抖振) Z_alpha -K_slide * sat(e_alpha, boundary); Z_beta -K_slide * sat(e_beta, boundary); // 觀測器狀態(tài)更新 (前向歐拉法離散化) I_alpha_hat Ts * ( -Rs/Ls * I_alpha_hat We_hat * I_beta_hat (V_alpha - Z_alpha)/Ls ); I_beta_hat Ts * ( -Rs/Ls * I_beta_hat - We_hat * I_alpha_hat (V_beta - Z_beta)/Ls ); // 反電動(dòng)勢估算值 E_alpha_est Z_alpha; E_beta_est Z_beta;這里的關(guān)鍵參數(shù)是滑模增益K_slide和飽和函數(shù)的邊界值boundary。K_slide需要足夠大以保證系統(tǒng)滿足滑?？蛇_(dá)條件但太大會(huì)加劇抖振和噪聲。boundary的選擇則是在響應(yīng)速度和平滑度之間做權(quán)衡。通常需要根據(jù)電機(jī)參數(shù)Rs, Ls和電氣時(shí)間常數(shù)進(jìn)行初步計(jì)算然后通過實(shí)驗(yàn)微調(diào)。我的經(jīng)驗(yàn)是先從理論值的0.5倍開始觀察估算反電動(dòng)勢的波形調(diào)整到既有快速跟蹤能力波形又相對(duì)干凈的狀態(tài)。3.3 鎖相環(huán)PLL提取角度與速度SMO輸出的是包含位置信息的反電動(dòng)勢分量Eα和Eβ。我們需要從中提取出平滑的轉(zhuǎn)子角度θ和電角速度ωe。一個(gè)基于反正切函數(shù)的PLL是標(biāo)準(zhǔn)做法。PLL的原理是先通過反正切函數(shù)atan2(-E_alpha, E_beta)得到一個(gè)粗略的、可能包含噪聲的位置信號(hào)θ_raw。但這個(gè)信號(hào)是跳變的在-π到π之間。PLL內(nèi)部有一個(gè)相位檢測器比較估算角度θ_est和粗略角度θ_raw的差值將這個(gè)差值通過一個(gè)PI調(diào)節(jié)器其輸出就是估算的電角速度ωe_est。再將這個(gè)速度積分就得到了平滑后的估算角度θ_est。// PLL實(shí)現(xiàn)核心 theta_raw atan2f(-E_alpha_est, E_beta_est); // 注意象限處理atan2返回值在[-pi, pi] // 處理角度卷繞使theta_raw連續(xù) theta_raw unwrap(theta_raw, prev_theta_raw); phase_error theta_raw - theta_est; // PI調(diào)節(jié)器處理相位誤差輸出為估算電速度 omega_est pll_kp * phase_error pll_ki * pll_integral; pll_integral phase_error * Ts; // 積分項(xiàng) // 積分得到平滑角度 theta_est omega_est * Ts;PLL參數(shù)pll_kp和pll_ki的整定至關(guān)重要。pll_kp決定了跟蹤速度pll_ki用于消除靜態(tài)誤差。我的調(diào)試步驟是先將pll_ki設(shè)為0逐漸增大pll_kp直到系統(tǒng)能夠快速鎖定但又不產(chǎn)生超調(diào)振蕩然后加入較小的pll_ki以消除穩(wěn)態(tài)誤差。這個(gè)過程需要在電機(jī)不同轉(zhuǎn)速下反復(fù)驗(yàn)證。實(shí)操心得在啟動(dòng)和極低速時(shí)反電動(dòng)勢信號(hào)很弱SMO和PLL可能無法正常工作。因此無感FOC必須包含一個(gè)獨(dú)立的“啟動(dòng)與低速運(yùn)行”策略。我采用的是“開環(huán)啟動(dòng)”“切換”策略。先以預(yù)設(shè)的V/f曲線即I-F控制將電機(jī)拖到一定速度例如10%額定轉(zhuǎn)速產(chǎn)生足夠強(qiáng)的反電動(dòng)勢后再平滑地將控制權(quán)交給基于SMO的閉環(huán)FOC。這個(gè)切換點(diǎn)的判斷和切換過程的平滑性是算法穩(wěn)定性的關(guān)鍵需要仔細(xì)設(shè)計(jì)滯回比較和漸變過渡邏輯。4. 在MCX A MCU上的工程實(shí)現(xiàn)與優(yōu)化算法理論通了下一步就是把它塞進(jìn)MCX A這顆MCU里并讓它高效、穩(wěn)定地跑起來。這涉及到外設(shè)配置、實(shí)時(shí)性保障和性能優(yōu)化。4.1 關(guān)鍵外設(shè)配置與初始化MCX A系列通常配備多個(gè)高級(jí)定時(shí)器、高精度ADC和豐富的通信接口。我的配置核心圍繞以下幾點(diǎn)PWM定時(shí)器用于生成SVPWM。我使用一個(gè)通用定時(shí)器如CTIMER的中心對(duì)齊模式產(chǎn)生六路帶死區(qū)互補(bǔ)的PWM輸出。死區(qū)時(shí)間必須根據(jù)所使用的功率器件IGBT或MOSFET的開關(guān)特性謹(jǐn)慎設(shè)置通常通過定時(shí)器的死區(qū)插入功能硬件實(shí)現(xiàn)這比軟件模擬更可靠。PWM頻率開關(guān)頻率我設(shè)置為16kHz這是一個(gè)在開關(guān)損耗、電流紋波和CPU計(jì)算負(fù)擔(dān)之間較好的折中點(diǎn)。MCX的定時(shí)器支持影子寄存器可以在一個(gè)PWM周期結(jié)束后自動(dòng)更新占空比避免中間切換產(chǎn)生毛刺。ADC用于電流和電壓采樣。配置兩個(gè)ADC模塊或一個(gè)ADC的兩個(gè)通道在PWM定時(shí)器的特定觸發(fā)事件如計(jì)數(shù)器下溢或中點(diǎn)同步啟動(dòng)采樣。必須啟用DMA將采樣結(jié)果直接搬運(yùn)到內(nèi)存中的指定數(shù)組避免CPU干預(yù)。ADC的采樣精度和速度要足夠12位分辨率、1Msps以上采樣率是基本要求。還需要配置好模擬輸入通道的引腳復(fù)用。時(shí)鐘系統(tǒng)確保CPU主頻、定時(shí)器時(shí)鐘和ADC時(shí)鐘都設(shè)置正確且穩(wěn)定。MCX A可能支持多種時(shí)鐘源內(nèi)部IRC、外部晶振、PLL我通常使用外部晶振通過PLL倍頻得到系統(tǒng)主頻以保證定時(shí)和采樣的長期穩(wěn)定性。GPIO與保護(hù)將PWM輸出引腳配置為高驅(qū)動(dòng)能力模式。一定要配置硬件過流保護(hù)如果MCU支持或至少用高速比較器配合GPIO中斷實(shí)現(xiàn)軟件保護(hù)。故障安全引腳如MCU的_FB_引腳要正確連接確保在過流時(shí)能硬件封鎖PWM輸出。4.2 軟件架構(gòu)與中斷服務(wù)程序設(shè)計(jì)無感FOC是一個(gè)強(qiáng)實(shí)時(shí)系統(tǒng)必須采用中斷驅(qū)動(dòng)。我的軟件架構(gòu)如下主循環(huán)負(fù)責(zé)非實(shí)時(shí)任務(wù)如通訊UART/CAN接收指令、發(fā)送狀態(tài)、狀態(tài)機(jī)管理啟動(dòng)、運(yùn)行、故障、停止、參數(shù)讀寫、上位機(jī)調(diào)試接口等。高優(yōu)先級(jí)中斷如PWM周期中斷這是FOC算法的核心執(zhí)行地。中斷頻率等于PWM頻率16kHz。在這個(gè)中斷服務(wù)程序ISR里必須順序完成以下操作讀取DMA搬運(yùn)過來的最新電流、電壓ADC值。執(zhí)行電流坐標(biāo)變換Clarke, Park。運(yùn)行電流環(huán)PI調(diào)節(jié)器產(chǎn)生Vd, Vq。執(zhí)行滑模觀測器SMO和鎖相環(huán)PLL估算角度和速度。執(zhí)行速度環(huán)PI調(diào)節(jié)器如果需要閉環(huán)速度控制。進(jìn)行反Park變換和SVPWM計(jì)算更新下一個(gè)PWM周期的比較寄存器值。低優(yōu)先級(jí)中斷用于處理過流故障、編碼器接口如果有、通訊接收等。關(guān)鍵優(yōu)化點(diǎn)ISR內(nèi)禁用浮點(diǎn)盡管MCX A有FPU但在16kHz的中斷里進(jìn)行大量浮點(diǎn)運(yùn)算仍可能吃滿CPU。我將所有核心算法坐標(biāo)變換、PI、SMO、PLL全部用定點(diǎn)數(shù)Q格式實(shí)現(xiàn)。例如使用Q15或Q31格式表示小數(shù)用整數(shù)乘法和移位代替浮點(diǎn)運(yùn)算速度能提升數(shù)倍。這是保證在高開關(guān)頻率下仍有足夠時(shí)間裕度的關(guān)鍵。查表法對(duì)于sin/cos、反正切等復(fù)雜函數(shù)使用預(yù)先計(jì)算好的查找表。對(duì)于角度將360度分為512或1024份存儲(chǔ)對(duì)應(yīng)的sin和cos值。對(duì)于atan2可以使用簡化算法或分段線性逼近而不是調(diào)用庫函數(shù)。充分利用硬件檢查MCX A是否有三角函數(shù)加速單元Cordic、濾波器協(xié)處理器等如果有務(wù)必用上能極大減輕CPU負(fù)擔(dān)。變量范圍與標(biāo)幺化將電流、電壓、角度等物理量進(jìn)行標(biāo)幺化處理使其落在[-1, 1]或[0, 1]范圍內(nèi)便于定點(diǎn)數(shù)處理和參數(shù)整定。4.3 SVPWM模塊的實(shí)現(xiàn)細(xì)節(jié)空間矢量脈寬調(diào)制SVPWM是提高直流母線電壓利用率和降低諧波的關(guān)鍵。其實(shí)現(xiàn)步驟固定根據(jù)Vα和Vβ由Vd, Vq經(jīng)反Park變換得到判斷所在的扇區(qū)。計(jì)算相鄰兩個(gè)基本電壓矢量的作用時(shí)間T1, T2。根據(jù)扇區(qū)計(jì)算三相PWM比較值Ta, Tb, Tc?？紤]死區(qū)時(shí)間最終設(shè)置定時(shí)器的比較寄存器。在MCU中需要特別注意計(jì)算過程中的溢出和邊界檢查。例如T1T2不能超過一個(gè)PWM周期。我通常會(huì)將計(jì)算出的時(shí)間轉(zhuǎn)換為定時(shí)器計(jì)數(shù)器的值并在賦值前進(jìn)行限幅。// 簡化的SVPWM扇區(qū)判斷和時(shí)間計(jì)算偽代碼 v_alpha ...; // 反Park變換得到 v_beta ...; // 扇區(qū)判斷 if (v_beta 0) { if (v_alpha 0) { if (v_beta * SQRT3 v_alpha) sector 1; else sector 2; } else { if (v_beta * SQRT3 -v_alpha) sector 3; else sector 4; } } else { // ... 類似邏輯判斷扇區(qū)5,6,1,2 } // 根據(jù)扇區(qū)計(jì)算X, Y, Z和時(shí)間T1, T2 // ... // 計(jì)算占空比 t_a (PWM_PERIOD - T1 - T2) / 2; t_b t_a T1; t_c t_b T2; // 根據(jù)扇區(qū)映射到實(shí)際的U, V, W相 // ... // 設(shè)置比較寄存器注意減去死區(qū)時(shí)間5. 調(diào)試過程、問題排查與參數(shù)整定實(shí)錄理論完美代碼寫完一上電電機(jī)可能紋絲不動(dòng)或者瘋狂抖動(dòng)。這才是真正工作的開始。調(diào)試無感FOC是一個(gè)系統(tǒng)工程需要清晰的步驟和耐心。5.1 分步調(diào)試法從開環(huán)到閉環(huán)絕對(duì)不要試圖一上來就運(yùn)行完整的無感FOC閉環(huán)。必須分步驗(yàn)證硬件與基礎(chǔ)外設(shè)測試不接電機(jī)用示波器觀察六路PWM輸出波形確認(rèn)死區(qū)正確占空比可調(diào)。測試ADC采樣注入已知電壓看讀取值是否正確。開環(huán)V/F控制測試這是驗(yàn)證功率電路和基本控制邏輯的第一步。讓電機(jī)在開環(huán)下勻速旋轉(zhuǎn)用電流鉗觀察三相電流是否為正弦波且平衡。同時(shí)可以驗(yàn)證坐標(biāo)變換是否正確在開環(huán)旋轉(zhuǎn)時(shí)手動(dòng)將估算角度設(shè)為真實(shí)角度如果裝有編碼器或設(shè)為開環(huán)給定的角度然后觀察d-q軸電流。在理想情況下Iq應(yīng)該接近轉(zhuǎn)矩電流指令I(lǐng)d應(yīng)該接近0。如果Id很大說明變換角度有誤。電流環(huán)調(diào)試在開環(huán)旋轉(zhuǎn)的基礎(chǔ)上將速度環(huán)打開但設(shè)為0讓電機(jī)靜止在某個(gè)位置需要編碼器或強(qiáng)制給一個(gè)固定角度。然后注入一個(gè)階躍的Iq指令觀察Iq的響應(yīng)。調(diào)整電流環(huán)PI參數(shù)先P后I目標(biāo)是響應(yīng)快速且無超調(diào)。這一步需要在多個(gè)不同的電角度下重復(fù)以驗(yàn)證電流解耦的效果。觀測器與PLL調(diào)試關(guān)鍵在開環(huán)旋轉(zhuǎn)狀態(tài)下將觀測器估算的角度和速度輸出與開環(huán)給定的角度和速度進(jìn)行比較。調(diào)整SMO的滑模增益和PLL的PI參數(shù)使估算值能快速、平穩(wěn)地跟蹤給定值。此時(shí)可以暫時(shí)不將估算角度用于反饋。閉環(huán)切換當(dāng)觀測器在開環(huán)狀態(tài)下能穩(wěn)定跟蹤后嘗試進(jìn)行開環(huán)到閉環(huán)的切換。切換邏輯要柔和例如在切換瞬間將閉環(huán)的電流環(huán)輸出與開環(huán)的電壓指令進(jìn)行加權(quán)混合逐漸過渡。密切觀察切換瞬間的電流和速度是否平穩(wěn)。5.2 常見問題與排查技巧以下是我在調(diào)試MCX A無感FOC項(xiàng)目中遇到的一些典型問題及解決方法問題現(xiàn)象可能原因排查思路與解決方法電機(jī)不轉(zhuǎn)或輕微抖動(dòng)后停住1. 電機(jī)相序接反。2. PWM死區(qū)時(shí)間過長或過短。3. 電流采樣極性錯(cuò)誤或偏移未校準(zhǔn)。4. 觀測器未收斂估算角度錯(cuò)誤。1. 任意交換兩相電機(jī)線或修改軟件相序映射。2. 用示波器測量上下橋臂驅(qū)動(dòng)波形確保有死區(qū)且無重疊。根據(jù)器件手冊(cè)調(diào)整死區(qū)時(shí)間。3. 電機(jī)靜止時(shí)讀取三相ADC值應(yīng)為0附近。施加一個(gè)小的電壓矢量觀察電流采樣值變化方向是否正確。4. 在開環(huán)模式下對(duì)比給定角度和估算角度波形。檢查SMO和PLL參數(shù)是否過于激進(jìn)或保守。電機(jī)旋轉(zhuǎn)但噪音大、振動(dòng)劇烈1. 電流環(huán)PI參數(shù)不合適通常是積分過大或比例過大。2. PWM開關(guān)頻率過低電流紋波大。3. 觀測器估算的角度有高頻噪聲。4. SVPWM計(jì)算中存在數(shù)值溢出或錯(cuò)誤。1. 重新整定電流環(huán)優(yōu)先保證穩(wěn)定再求快速?？蓵簳r(shí)將積分項(xiàng)設(shè)為零調(diào)試。2. 適當(dāng)提高PWM頻率如從8k提到16k或20k注意評(píng)估開關(guān)損耗和MCU計(jì)算能力。3. 檢查PLL的帶寬降低PLL的pll_kp增益增加濾波。檢查SMO輸出的反電動(dòng)勢信號(hào)是否干凈。4. 檢查SVPWM計(jì)算中的變量范圍特別是作用時(shí)間T1、T2確保其和不超過PWM周期。中高速運(yùn)行正常但啟動(dòng)困難或低速抖動(dòng)1. 開環(huán)啟動(dòng)階段參數(shù)V/F曲線不合適。2. 開環(huán)到閉環(huán)的切換點(diǎn)設(shè)置不當(dāng)。3. 低速時(shí)反電動(dòng)勢信號(hào)弱觀測器信噪比低。1. 調(diào)整開環(huán)啟動(dòng)的電壓提升IR補(bǔ)償和頻率斜坡斜率確保有足夠的啟動(dòng)力矩。2. 延遲切換點(diǎn)確保電機(jī)在更高速度下再切入閉環(huán)。設(shè)計(jì)平滑的切換過渡算法。3. 考慮在低速區(qū)使用I-F控制電流-頻率控制作為過渡或者嘗試更先進(jìn)的觀測器如自適應(yīng)觀測器以提升低速性能。帶載能力差稍加負(fù)載就失步1. 電流環(huán)帶寬不足動(dòng)態(tài)響應(yīng)慢。2. 速度環(huán)PI參數(shù)未整定好。3. 直流母線電壓不足或母線電容太小。4. 電機(jī)參數(shù)Rs, Ls, Flux不準(zhǔn)確特別是轉(zhuǎn)子磁鏈。1. 在安全范圍內(nèi)增大電流環(huán)比例增益或檢查ADC采樣和計(jì)算延時(shí)是否過大。2. 閉環(huán)速度模式下重新整定速度環(huán)PI參數(shù)。3. 檢查電源增大母線電容以穩(wěn)定電壓。4. 進(jìn)行電機(jī)參數(shù)辨識(shí)。Rs可通過直流注入法測量Ls和Flux可通過特定測試流程或在線辨識(shí)算法獲得。更新控制器中的電機(jī)參數(shù)。估算角度與真實(shí)角度存在固定偏差1. 電流采樣通道的相位延遲不一致。2. 軟件計(jì)算中的角度補(bǔ)償不準(zhǔn)確。3. PWM更新時(shí)刻與ADC采樣時(shí)刻不匹配。1. 檢查ADC采樣保持時(shí)間和信號(hào)調(diào)理電路的相位特性確保三相一致。2. 在已知正確角度如編碼器的情況下測量偏差值在軟件中增加一個(gè)固定的角度補(bǔ)償offset。3. 精確計(jì)算從PWM更新到ADC采樣到算法執(zhí)行完畢的整個(gè)延時(shí)并在角度估算中進(jìn)行超前補(bǔ)償。5.3 參數(shù)整定的經(jīng)驗(yàn)法則電流環(huán)帶寬通常設(shè)為開關(guān)頻率的1/10到1/5。先設(shè)Ki0增大Kp直到系統(tǒng)出現(xiàn)輕微振蕩然后取該值的60%~70%。再引入較小的Ki以消除靜差。速度環(huán)帶寬應(yīng)遠(yuǎn)低于電流環(huán)通常低一個(gè)數(shù)量級(jí)。整定方法類似但更注重抗負(fù)載擾動(dòng)的能力。SMO滑模增益與反電動(dòng)勢幅值相關(guān)?？梢韵雀鶕?jù)電機(jī)額定反電動(dòng)勢和母線電壓估算一個(gè)值然后以電機(jī)額定速度的20%運(yùn)行觀察估算反電動(dòng)勢波形調(diào)整增益使其波形清晰且噪聲可接受。PLL參數(shù)pll_kp決定了跟蹤帶寬?？梢栽O(shè)置為期望的動(dòng)態(tài)響應(yīng)速度對(duì)應(yīng)的頻率如100Hz的2π倍作為初值。pll_ki設(shè)為pll_kp的1/10到1/100用于消除穩(wěn)態(tài)誤差。調(diào)試過程中一個(gè)強(qiáng)大的上位機(jī)工具至關(guān)重要。我通常會(huì)通過MCU的串口或CAN實(shí)時(shí)將關(guān)鍵變量如Id, Iq, 估算角度 真實(shí)角度 速度指令 速度反饋等發(fā)送到電腦用類似MATLAB或自定義的QT/Python工具繪制波形。圖形化的對(duì)比能讓你瞬間定位問題所在。6. 性能優(yōu)化與進(jìn)階考量當(dāng)基本功能跑通后就可以考慮進(jìn)一步優(yōu)化性能和擴(kuò)展功能了。6.1 利用MCX A的特定硬件加速M(fèi)CX A系列可能集成了一些能顯著提升FOC性能的模塊三角函數(shù)單元Cordic如果存在務(wù)必用它來加速sin、cos、atan2的計(jì)算能節(jié)省大量CPU周期?？删幊踢壿媶卧鏟LC或PFA一些MCU內(nèi)置了小規(guī)模FPGA或可編程邏輯陣列。可以考慮將SVPWM生成、ADC觸發(fā)邏輯甚至簡單的保護(hù)功能下放到硬件中實(shí)現(xiàn)進(jìn)一步解放CPU。硬件除法器和乘加單元確保編譯器優(yōu)化選項(xiàng)開啟充分利用這些單元進(jìn)行定點(diǎn)數(shù)運(yùn)算。內(nèi)存加速器如Cache將頻繁訪問的數(shù)據(jù)如sin/cos表、PI控制器結(jié)構(gòu)體放到TCM或帶Cache的內(nèi)存區(qū)域減少訪問延遲。6.2 增加魯棒性與可靠性功能一個(gè)工業(yè)級(jí)的產(chǎn)品不能只停留在“能轉(zhuǎn)”參數(shù)在線辨識(shí)電機(jī)參數(shù)Rs, Ls會(huì)隨溫度變化?？梢詫?shí)現(xiàn)在線辨識(shí)算法在電機(jī)運(yùn)行于特定狀態(tài)時(shí)自動(dòng)更新參數(shù)提升控制精度。故障診斷與保護(hù)完善過流、過壓、欠壓、過熱、堵轉(zhuǎn)、失速等故障檢測與保護(hù)邏輯。MCX A的模擬比較器和PWM故障輸入引腳要充分利用。弱磁控制當(dāng)電機(jī)轉(zhuǎn)速超過基速時(shí)需要注入負(fù)的Id電流來削弱磁場以實(shí)現(xiàn)更高轉(zhuǎn)速的運(yùn)行。這需要擴(kuò)展電流環(huán)的指令生成邏輯。能耗制動(dòng)在快速減速或大慣量負(fù)載時(shí)需要將再生能量消耗在制動(dòng)電阻上這涉及到對(duì)母線電壓的監(jiān)控和制動(dòng)IGBT的控制。6.3 與開發(fā)工具的配合以J-Flash為例在開發(fā)過程中可能會(huì)遇到像“J-Flash里面沒有所需要的MCU型號(hào)”這樣的工具鏈問題。這很常見尤其是對(duì)于像MCX A這樣的新系列MCU。我的解決思路是檢查J-Flash版本確保你使用的是最新版本的J-Flash軟件Segger會(huì)定期更新設(shè)備支持包。手動(dòng)安裝設(shè)備支持包前往MCU廠商N(yùn)XP的官網(wǎng)或Segger官網(wǎng)查找并下載對(duì)應(yīng)MCU系列的J-Flash設(shè)備支持包Device Family Pack DFP然后按照說明手動(dòng)安裝到J-Flash的安裝目錄下。使用通用配置文件如果官方?jīng)]有提供有時(shí)可以找一個(gè)內(nèi)核相同如Cortex-M33、Flash大小和地址映射相似的現(xiàn)有型號(hào)的配置文件然后手動(dòng)修改其Flash編程算法和內(nèi)存映射文件。但這需要你對(duì)MCU的存儲(chǔ)架構(gòu)和J-Flash的配置文件格式有較深了解風(fēng)險(xiǎn)較高。換用廠商官方工具很多時(shí)候MCU廠商自己的編程/調(diào)試工具如NXP的MCUXpresso IDE自帶的調(diào)試器對(duì)新芯片的支持是最快的?？梢韵扔霉俜焦ぞ哌M(jìn)行燒錄和調(diào)試等待第三方工具更新。最后我想說的是無感FOC在MCX A這類現(xiàn)代MCU上的實(shí)現(xiàn)已經(jīng)不再是遙不可及的黑科技。它是一系列經(jīng)典控制理論、數(shù)字信號(hào)處理技術(shù)和嵌入式工程實(shí)踐的有機(jī)結(jié)合。這個(gè)項(xiàng)目的成功關(guān)鍵在于對(duì)每個(gè)模塊原理的透徹理解、嚴(yán)謹(jǐn)?shù)墓こ虒?shí)現(xiàn)方法以及系統(tǒng)性的調(diào)試策略。從開環(huán)到閉環(huán)從空載到帶載每一步遇到的問題都是加深理解的契機(jī)。當(dāng)你第一次看到電機(jī)在無傳感器的情況下平穩(wěn)地跟隨速度指令變化時(shí)那種成就感是對(duì)所有調(diào)試煎熬的最好回報(bào)。希望這份基于實(shí)際項(xiàng)目的梳理能為你點(diǎn)亮這條路上的幾盞燈。