控制實(shí)戰(zhàn)：電流環(huán)、速度環(huán)、位置環(huán)的工程落地與參數(shù)整定)
簡介這份資源面向?qū)W習(xí)電機(jī)控制、準(zhǔn)備在STM32F4平臺上實(shí)現(xiàn)有感FOC的開發(fā)者提供一套親手編寫的三環(huán)控制算法代碼。內(nèi)容覆蓋坐標(biāo)變換、PID調(diào)節(jié)、SVPWM生成、編碼器讀取與電流采樣等核心環(huán)節(jié)適合已掌握C語言與STM32基礎(chǔ)、希望深入理解磁場定向控制實(shí)現(xiàn)細(xì)節(jié)的中級學(xué)習(xí)者。壓縮包共194個文件約5.05MB以57個h頭文件與46個c源文件為主體配合22個d依賴文件、22個o目標(biāo)文件及axf、hex、map等編譯產(chǎn)物另有sct分散加載、uvprojx工程與bat腳本等構(gòu)成可直接編譯調(diào)試的完整工程。目前已有979人學(xué)習(xí)下載。讀者可據(jù)此梳理三環(huán)控制的代碼組織方式對照坐標(biāo)變換與SVPWM模塊理解算法落地過程并借助工程文件快速搭建驗(yàn)證環(huán)境作者另在《基于擴(kuò)展卡爾曼濾波器的電機(jī)轉(zhuǎn)子位置估測》中提供無感算法的Matlab仿真、C實(shí)現(xiàn)與公式推導(dǎo)文檔可作延伸參考。1. 有感 FOC 三環(huán)控制從電流環(huán)到速度環(huán)的工程落地很多做電機(jī)控制的朋友第一次接觸 FOC都會被坐標(biāo)變換、SVPWM、電流采樣這些環(huán)節(jié)繞暈但真正讓電機(jī)從“能轉(zhuǎn)”變成“轉(zhuǎn)得穩(wěn)、響應(yīng)快、帶載不抖”的是三環(huán)控制的整定。我手上這份有感 FOC 算法實(shí)現(xiàn)資料核心就是一套完整的三環(huán)結(jié)構(gòu)電流環(huán)、速度環(huán)、位置環(huán)配合霍爾或編碼器反饋跑在常見的 MCU 上。它解決的不是“FOC 是什么”這種教科書問題而是“代碼怎么搭、參數(shù)怎么調(diào)、為什么我的電機(jī)一上負(fù)載就嘯叫”這類實(shí)操痛點(diǎn)。適合已經(jīng)能跑通開環(huán)、想進(jìn)一步把閉環(huán)做扎實(shí)的嵌入式工程師也適合做云臺、電調(diào)、伺服模組的從業(yè)者拿來對照自己的實(shí)現(xiàn)。下面我按自己拆包復(fù)現(xiàn)的順序把這份資源里的三環(huán)結(jié)構(gòu)、參數(shù)整定和踩坑點(diǎn)講清楚。2. 三環(huán)架構(gòu)拆解電流環(huán)、速度環(huán)、位置環(huán)各自管什么2.1 為什么是三環(huán)而不是兩環(huán)FOC 的本質(zhì)是把三相電流解耦成勵磁分量 Id 和轉(zhuǎn)矩分量 Iq然后分別控制。電流環(huán)是最內(nèi)環(huán)直接決定力矩響應(yīng)和電流波形質(zhì)量速度環(huán)套在電流環(huán)外面輸出 Iq 的參考值位置環(huán)再套在速度環(huán)外面輸出速度參考值。三環(huán)串聯(lián)的結(jié)構(gòu)讓每一層只關(guān)心自己的誤差內(nèi)環(huán)響應(yīng)必須遠(yuǎn)快于外環(huán)否則整個系統(tǒng)會振蕩。常見做法是電流環(huán)帶寬設(shè)在 1~2 kHz速度環(huán) 100~200 Hz位置環(huán) 20~50 Hz三者拉開 5~10 倍差距。這份資源里的代碼把三個環(huán)寫成獨(dú)立的 PID 函數(shù)通過一個調(diào)度器按不同頻率調(diào)用電流環(huán)跑在 PWM 中斷里速度環(huán)和位置環(huán)跑在定時器任務(wù)里這種分層調(diào)度是工程上最穩(wěn)的寫法。2.2 電流環(huán)的實(shí)現(xiàn)細(xì)節(jié)與參數(shù)電流環(huán)的輸入是 Id_ref、Iq_ref 和采樣回來的 Id、Iq輸出是 Vd、Vq再經(jīng)過反 Park 變換和 SVPWM 生成占空比。這份實(shí)現(xiàn)里電流環(huán)用的是 PI 控制器沒有加 D 項(xiàng)因?yàn)殡娏餍盘栐肼暣笪⒎謺言肼暦糯蟆I 參數(shù)整定有個經(jīng)驗(yàn)公式先把積分項(xiàng)置零逐漸增大 Kp 直到電流出現(xiàn)小幅振蕩然后取振蕩臨界值的 0.6 倍作為 Kp再調(diào) Ki 讓階躍響應(yīng)在 1~2 ms 內(nèi)穩(wěn)定。代碼里 Kp 和 Ki 是分開的宏定義方便在線調(diào)試時通過串口修改。// 電流環(huán) PI 控制器Id 和 Iq 共用一套參數(shù) typedef struct { float Kp; float Ki; float integral; float out_max; float out_min; } PI_Controller; float PI_Update(PI_Controller *pi, float error) { // 比例項(xiàng)直接乘誤差 float p_term pi-Kp * error; // 積分項(xiàng)累加注意限幅防止飽和 pi-integral pi-Ki * error; if (pi-integral pi-out_max) pi-integral pi-out_max; if (pi-integral pi-out_min) pi-integral pi-out_min; float output p_term pi-integral; // 輸出限幅對應(yīng)最大電壓矢量 if (output pi-out_max) output pi-out_max; if (output pi-out_min) output pi-out_min; return output; }這段代碼里out_max和out_min對應(yīng) SVPWM 能輸出的最大電壓通常設(shè)為母線電壓的 1/√3。積分限幅和輸出限幅必須同時做否則一旦誤差持續(xù)存在積分項(xiàng)會無限累加退出飽和時電機(jī)就會猛沖一下。我一般會把out_max設(shè)成實(shí)際最大電壓的 0.95 倍留一點(diǎn)余量給死區(qū)補(bǔ)償。2.3 速度環(huán)與位置環(huán)的串級設(shè)計速度環(huán)的反饋來自霍爾傳感器或編碼器的差分計算輸入是速度誤差輸出是 Iq_ref。這里有個關(guān)鍵點(diǎn)速度環(huán)的輸出必須限幅因?yàn)?Iq 對應(yīng)轉(zhuǎn)矩過大的 Iq 會觸發(fā)過流保護(hù)。這份資源里速度環(huán)的限幅值是根據(jù)電機(jī)額定電流和采樣電阻算出來的不是隨便填的。位置環(huán)的反饋是角度誤差輸出是速度參考值同樣需要限幅防止電機(jī)在位置突變時飛車。速度環(huán)的 PI 參數(shù)整定比電流環(huán)麻煩因?yàn)樗俣刃盘柋旧碛辛炕肼?。常見做法是先用低通濾波器把速度反饋濾一下截止頻率設(shè)在速度環(huán)帶寬的 2~3 倍。然后按電流環(huán)同樣的方法調(diào) Kp 和 Ki但要注意速度環(huán)的響應(yīng)不能太快否則會和電流環(huán)耦合產(chǎn)生振蕩。我一般會把速度環(huán)的 Kp 從很小的值開始加觀察電機(jī)在突加負(fù)載時的轉(zhuǎn)速跌落跌落越小越好但不能出現(xiàn)持續(xù)振蕩。位置環(huán)通常用 P 控制就夠了因?yàn)槲恢谜`差的積分項(xiàng)容易在到達(dá)目標(biāo)后產(chǎn)生過沖。如果必須用 PI積分項(xiàng)要加一個很小的上限。這份實(shí)現(xiàn)里位置環(huán)的 Kp 是根據(jù)最大速度除以最大允許位置誤差來估算的比如最大速度 3000 rpm允許誤差 1 度那 Kp 大概在 50 左右實(shí)際還要根據(jù)機(jī)械慣量調(diào)整。3. 從零搭建三環(huán)代碼結(jié)構(gòu)與調(diào)度邏輯3.1 工程文件組織與初始化順序拿到這份資源后我習(xí)慣先看它的文件結(jié)構(gòu)。通常會有foc_core.c、pid.c、svpwm.c、encoder.c這幾個核心文件外加一個main.c做調(diào)度。初始化順序很重要先初始化時鐘和 GPIO再初始化 ADC 和 PWM然后初始化編碼器接口最后使能中斷。如果順序錯了比如先開中斷再初始化 ADC第一次中斷觸發(fā)時 ADC 還沒準(zhǔn)備好讀回來的電流就是垃圾值電機(jī)可能直接抖一下。// 初始化順序示例每一步都不能省 void System_Init(void) { Clock_Init(); // 系統(tǒng)時鐘決定 PWM 頻率 GPIO_Init(); // 引腳復(fù)用PWM 和 ADC 通道 ADC_Init(); // 電流采樣校準(zhǔn)零點(diǎn) PWM_Init(); // 中心對齊模式死區(qū)時間 Encoder_Init(); // 編碼器接口或霍爾捕獲 PID_Init(); // 三個環(huán)的 PID 參數(shù)初始化 Enable_Interrupts(); // 最后開中斷 }ADC_Init里一定要做零點(diǎn)校準(zhǔn)因?yàn)檫\(yùn)放有失調(diào)電壓。校準(zhǔn)方法是在 PWM 輸出關(guān)閉時采多次電流取平均值作為零點(diǎn)偏移。這個偏移不校準(zhǔn)電流環(huán)的積分項(xiàng)會一直累加電機(jī)不轉(zhuǎn)的時候電流采樣值都不是零。3.2 中斷調(diào)度與三環(huán)執(zhí)行頻率三環(huán)的執(zhí)行頻率決定了整個系統(tǒng)的實(shí)時性。這份資源里電流環(huán)放在 PWM 中斷里PWM 頻率 20 kHz電流環(huán)就是 20 kHz。速度環(huán)放在一個 1 kHz 的定時器中斷里位置環(huán)放在 100 Hz 的任務(wù)里。這種安排的原因是電流環(huán)需要和 PWM 同步速度環(huán)和位置環(huán)對實(shí)時性要求沒那么高放在低優(yōu)先級中斷里可以節(jié)省 CPU。// PWM 中斷服務(wù)函數(shù)電流環(huán)在這里執(zhí)行 void PWM_IRQHandler(void) { // 清除中斷標(biāo)志 PWM_ClearFlag(); // 讀取三相電流 float ia ADC_ReadPhaseA(); float ib ADC_ReadPhaseB(); float ic -ia - ib; // 基爾霍夫電流定律 // Clarke 變換 float ialpha ia; float ibeta (ia 2*ib) * ONE_BY_SQRT3; // Park 變換需要電角度 float theta Encoder_GetElecAngle(); float id ialpha * cosf(theta) ibeta * sinf(theta); float iq -ialpha * sinf(theta) ibeta * cosf(theta); // 電流環(huán) PI float vd PI_Update(pid_id, id_ref - id); float vq PI_Update(pid_iq, iq_ref - iq); // 反 Park 變換和 SVPWM SVPWM_Output(vd, vq, theta); }這段代碼里Encoder_GetElecAngle返回的是電角度不是機(jī)械角度。電角度等于機(jī)械角度乘以極對數(shù)這個換算在編碼器初始化時就要算好。如果極對數(shù)填錯電機(jī)要么不轉(zhuǎn)要么轉(zhuǎn)起來力矩很小。我見過有人把 7 對極的電機(jī)填成 4 對極結(jié)果電流環(huán)完全失控電機(jī)嗡嗡響但不轉(zhuǎn)。3.3 參數(shù)整定的實(shí)操步驟整定三環(huán)參數(shù)不能同時調(diào)必須從內(nèi)到外。先把速度環(huán)和位置環(huán)的輸出限幅設(shè)為零只讓電流環(huán)工作給 Iq_ref 一個階躍信號看電流波形。如果電流上升太慢增大 Kp如果電流超調(diào)大或者振蕩減小 Kp 或增大 Ki。電流環(huán)調(diào)好后把速度環(huán)輸出限幅放開給速度參考一個階躍調(diào)速度環(huán)的 Kp 和 Ki。最后調(diào)位置環(huán)。提示每次只調(diào)一個參數(shù)調(diào)完記錄波形不要憑感覺同時改好幾個參數(shù)否則出了問題根本不知道是哪個參數(shù)引起的。速度環(huán)整定時如果電機(jī)出現(xiàn)低頻振蕩通常是速度環(huán) Kp 太大如果轉(zhuǎn)速跌落恢復(fù)太慢是 Ki 太小。位置環(huán)如果到達(dá)目標(biāo)后來回晃是 Kp 太大或者沒有加死區(qū)。這份資源里每個環(huán)都有獨(dú)立的調(diào)試接口可以通過串口實(shí)時修改參數(shù)不用重新燒錄程序。4. 避坑與排查三環(huán)調(diào)試中最容易翻車的五個點(diǎn)4.1 電流采樣零點(diǎn)漂移導(dǎo)致積分飽和現(xiàn)象電機(jī)上電后不轉(zhuǎn)但電流采樣值一直在緩慢增大過幾秒后過流保護(hù)觸發(fā)。 原因運(yùn)放失調(diào)電壓隨溫度變化零點(diǎn)校準(zhǔn)只在初始化時做了一次運(yùn)行中漂移了。 解決在 PWM 中斷里定期更新零點(diǎn)比如每 100 次中斷取一次當(dāng)前電流作為新的零點(diǎn)但要在電機(jī)停轉(zhuǎn)時做?；蛘哂糜布\(yùn)放加調(diào)零電路。4.2 電角度對齊錯誤導(dǎo)致力矩不足現(xiàn)象電機(jī)能轉(zhuǎn)但帶載能力只有額定的一半電流波形畸變。 原因編碼器安裝偏差或者極對數(shù)填錯導(dǎo)致 Park 變換用的電角度和實(shí)際轉(zhuǎn)子位置差了一個固定角度。 解決做電角度對齊給 d 軸一個固定電壓讓轉(zhuǎn)子轉(zhuǎn)到 d 軸方向然后強(qiáng)制把編碼器角度清零。這份資源里有一個對齊函數(shù)調(diào)用一次就能自動完成。4.3 速度環(huán)反饋濾波過度導(dǎo)致響應(yīng)遲滯現(xiàn)象電機(jī)突加負(fù)載時轉(zhuǎn)速跌落很大恢復(fù)很慢但電流環(huán)響應(yīng)正常。 原因速度環(huán)反饋的低通濾波器截止頻率設(shè)得太低速度信號被嚴(yán)重滯后。 解決把濾波器截止頻率提高到速度環(huán)帶寬的 3 倍以上或者改用滑動平均濾波延遲更小。4.4 位置環(huán)積分項(xiàng)導(dǎo)致過沖現(xiàn)象位置指令給一個階躍電機(jī)沖過目標(biāo)位置再彈回來。 原因位置環(huán)用了 PI 控制積分項(xiàng)在接近目標(biāo)時還在累加。 解決位置環(huán)只用 P 控制或者給積分項(xiàng)加一個條件只在誤差大于某個閾值時才累加。4.5 中斷優(yōu)先級沖突導(dǎo)致電流環(huán)丟步現(xiàn)象電機(jī)高速運(yùn)行時偶爾出現(xiàn)咔噠聲電流波形有毛刺。 原因速度環(huán)中斷優(yōu)先級高于電流環(huán)速度環(huán)執(zhí)行時間過長時打斷了電流環(huán)。 解決把電流環(huán)中斷設(shè)為最高優(yōu)先級速度環(huán)和位置環(huán)設(shè)為低優(yōu)先級。如果 MCU 支持把速度環(huán)和位置環(huán)放到主循環(huán)里輪詢不用中斷。5. 進(jìn)階技巧用示波器和串口波形驗(yàn)證三環(huán)性能調(diào)三環(huán)最怕的就是“盲調(diào)”改一個參數(shù)不知道好壞。我一般會同時用兩個手段示波器看電流波形串口上位機(jī)看速度響應(yīng)曲線。這份資源里預(yù)留了一個 DAC 輸出接口可以把 Id、Iq 或者速度值實(shí)時輸出到示波器上。如果沒有 DAC就用串口每隔 1 ms 發(fā)一次數(shù)據(jù)上位機(jī)畫波形。// 串口發(fā)送波形數(shù)據(jù)格式Id, Iq, Speed, Position void Send_Waveform(void) { static uint32_t last_tick 0; if (GetTick() - last_tick 1) return; // 1ms 發(fā)送一次 last_tick GetTick(); printf(%.3f,%.3f,%.1f,%.2f\n, foc.id, foc.iq, foc.speed_rpm, foc.position_deg); }上位機(jī)用常見的串口波形軟件就行把數(shù)據(jù)解析成四通道。看電流環(huán)時給 Iq_ref 一個方波觀察 Iq 的實(shí)際跟蹤上升時間應(yīng)該在 1 ms 以內(nèi)超調(diào)小于 10%。看速度環(huán)時給速度參考一個階躍觀察轉(zhuǎn)速上升時間和跌落恢復(fù)時間。位置環(huán)看階躍響應(yīng)的過沖和穩(wěn)定時間。注意串口發(fā)送數(shù)據(jù)會占用 CPU 時間如果電流環(huán)頻率很高不要在電流環(huán)中斷里發(fā)串口放在低優(yōu)先級任務(wù)里。還有一個技巧是注入一個小的正弦擾動到 Iq_ref 上然后用示波器看 Iq 的響應(yīng)可以測出電流環(huán)的帶寬。如果帶寬低于 500 Hz說明 Kp 太小或者 PWM 頻率太低。我一般會把 PWM 頻率設(shè)在 16 kHz 以上這樣電流環(huán)帶寬能做到 1 kHz 以上電機(jī)聲音也人耳聽不到。從那以后我每次調(diào)新電機(jī)都強(qiáng)制走一遍“先電流環(huán)、再速度環(huán)、最后位置環(huán)”的順序絕不跳步。希望幫到你。本文還有配套的精品資源點(diǎn)擊獲取 有感FOC三環(huán)控制實(shí)戰(zhàn)：電流環(huán)、速度環(huán)、位置環(huán)的工程落地與參數(shù)整定
簡介這份資源面向?qū)W習(xí)電機(jī)控制、準(zhǔn)備在STM32F4平臺上實(shí)現(xiàn)有感FOC的開發(fā)者提供一套親手編寫的三環(huán)控制算法代碼。內(nèi)容覆蓋坐標(biāo)變換、PID調(diào)節(jié)、SVPWM生成、編碼器讀取與電流采樣等核心環(huán)節(jié)適合已掌握C語言與STM32基礎(chǔ)、希望深入理解磁場定向控制實(shí)現(xiàn)細(xì)節(jié)的中級學(xué)習(xí)者。壓縮包共194個文件約5.05MB以57個h頭文件與46個c源文件為主體配合22個d依賴文件、22個o目標(biāo)文件及axf、hex、map等編譯產(chǎn)物另有sct分散加載、uvprojx工程與bat腳本等構(gòu)成可直接編譯調(diào)試的完整工程。目前已有979人學(xué)習(xí)下載。讀者可據(jù)此梳理三環(huán)控制的代碼組織方式對照坐標(biāo)變換與SVPWM模塊理解算法落地過程并借助工程文件快速搭建驗(yàn)證環(huán)境作者另在《基于擴(kuò)展卡爾曼濾波器的電機(jī)轉(zhuǎn)子位置估測》中提供無感算法的Matlab仿真、C實(shí)現(xiàn)與公式推導(dǎo)文檔可作延伸參考。1. 有感 FOC 三環(huán)控制從電流環(huán)到速度環(huán)的工程落地很多做電機(jī)控制的朋友第一次接觸 FOC都會被坐標(biāo)變換、SVPWM、電流采樣這些環(huán)節(jié)繞暈但真正讓電機(jī)從“能轉(zhuǎn)”變成“轉(zhuǎn)得穩(wěn)、響應(yīng)快、帶載不抖”的是三環(huán)控制的整定。我手上這份有感 FOC 算法實(shí)現(xiàn)資料核心就是一套完整的三環(huán)結(jié)構(gòu)電流環(huán)、速度環(huán)、位置環(huán)配合霍爾或編碼器反饋跑在常見的 MCU 上。它解決的不是“FOC 是什么”這種教科書問題而是“代碼怎么搭、參數(shù)怎么調(diào)、為什么我的電機(jī)一上負(fù)載就嘯叫”這類實(shí)操痛點(diǎn)。適合已經(jīng)能跑通開環(huán)、想進(jìn)一步把閉環(huán)做扎實(shí)的嵌入式工程師也適合做云臺、電調(diào)、伺服模組的從業(yè)者拿來對照自己的實(shí)現(xiàn)。下面我按自己拆包復(fù)現(xiàn)的順序把這份資源里的三環(huán)結(jié)構(gòu)、參數(shù)整定和踩坑點(diǎn)講清楚。2. 三環(huán)架構(gòu)拆解電流環(huán)、速度環(huán)、位置環(huán)各自管什么2.1 為什么是三環(huán)而不是兩環(huán)FOC 的本質(zhì)是把三相電流解耦成勵磁分量 Id 和轉(zhuǎn)矩分量 Iq然后分別控制。電流環(huán)是最內(nèi)環(huán)直接決定力矩響應(yīng)和電流波形質(zhì)量速度環(huán)套在電流環(huán)外面輸出 Iq 的參考值位置環(huán)再套在速度環(huán)外面輸出速度參考值。三環(huán)串聯(lián)的結(jié)構(gòu)讓每一層只關(guān)心自己的誤差內(nèi)環(huán)響應(yīng)必須遠(yuǎn)快于外環(huán)否則整個系統(tǒng)會振蕩。常見做法是電流環(huán)帶寬設(shè)在 1~2 kHz速度環(huán) 100~200 Hz位置環(huán) 20~50 Hz三者拉開 5~10 倍差距。這份資源里的代碼把三個環(huán)寫成獨(dú)立的 PID 函數(shù)通過一個調(diào)度器按不同頻率調(diào)用電流環(huán)跑在 PWM 中斷里速度環(huán)和位置環(huán)跑在定時器任務(wù)里這種分層調(diào)度是工程上最穩(wěn)的寫法。2.2 電流環(huán)的實(shí)現(xiàn)細(xì)節(jié)與參數(shù)電流環(huán)的輸入是 Id_ref、Iq_ref 和采樣回來的 Id、Iq輸出是 Vd、Vq再經(jīng)過反 Park 變換和 SVPWM 生成占空比。這份實(shí)現(xiàn)里電流環(huán)用的是 PI 控制器沒有加 D 項(xiàng)因?yàn)殡娏餍盘栐肼暣笪⒎謺言肼暦糯蟆I 參數(shù)整定有個經(jīng)驗(yàn)公式先把積分項(xiàng)置零逐漸增大 Kp 直到電流出現(xiàn)小幅振蕩然后取振蕩臨界值的 0.6 倍作為 Kp再調(diào) Ki 讓階躍響應(yīng)在 1~2 ms 內(nèi)穩(wěn)定。代碼里 Kp 和 Ki 是分開的宏定義方便在線調(diào)試時通過串口修改。// 電流環(huán) PI 控制器Id 和 Iq 共用一套參數(shù) typedef struct { float Kp; float Ki; float integral; float out_max; float out_min; } PI_Controller; float PI_Update(PI_Controller *pi, float error) { // 比例項(xiàng)直接乘誤差 float p_term pi-Kp * error; // 積分項(xiàng)累加注意限幅防止飽和 pi-integral pi-Ki * error; if (pi-integral pi-out_max) pi-integral pi-out_max; if (pi-integral pi-out_min) pi-integral pi-out_min; float output p_term pi-integral; // 輸出限幅對應(yīng)最大電壓矢量 if (output pi-out_max) output pi-out_max; if (output pi-out_min) output pi-out_min; return output; }這段代碼里out_max和out_min對應(yīng) SVPWM 能輸出的最大電壓通常設(shè)為母線電壓的 1/√3。積分限幅和輸出限幅必須同時做否則一旦誤差持續(xù)存在積分項(xiàng)會無限累加退出飽和時電機(jī)就會猛沖一下。我一般會把out_max設(shè)成實(shí)際最大電壓的 0.95 倍留一點(diǎn)余量給死區(qū)補(bǔ)償。2.3 速度環(huán)與位置環(huán)的串級設(shè)計速度環(huán)的反饋來自霍爾傳感器或編碼器的差分計算輸入是速度誤差輸出是 Iq_ref。這里有個關(guān)鍵點(diǎn)速度環(huán)的輸出必須限幅因?yàn)?Iq 對應(yīng)轉(zhuǎn)矩過大的 Iq 會觸發(fā)過流保護(hù)。這份資源里速度環(huán)的限幅值是根據(jù)電機(jī)額定電流和采樣電阻算出來的不是隨便填的。位置環(huán)的反饋是角度誤差輸出是速度參考值同樣需要限幅防止電機(jī)在位置突變時飛車。速度環(huán)的 PI 參數(shù)整定比電流環(huán)麻煩因?yàn)樗俣刃盘柋旧碛辛炕肼?。常見做法是先用低通濾波器把速度反饋濾一下截止頻率設(shè)在速度環(huán)帶寬的 2~3 倍。然后按電流環(huán)同樣的方法調(diào) Kp 和 Ki但要注意速度環(huán)的響應(yīng)不能太快否則會和電流環(huán)耦合產(chǎn)生振蕩。我一般會把速度環(huán)的 Kp 從很小的值開始加觀察電機(jī)在突加負(fù)載時的轉(zhuǎn)速跌落跌落越小越好但不能出現(xiàn)持續(xù)振蕩。位置環(huán)通常用 P 控制就夠了因?yàn)槲恢谜`差的積分項(xiàng)容易在到達(dá)目標(biāo)后產(chǎn)生過沖。如果必須用 PI積分項(xiàng)要加一個很小的上限。這份實(shí)現(xiàn)里位置環(huán)的 Kp 是根據(jù)最大速度除以最大允許位置誤差來估算的比如最大速度 3000 rpm允許誤差 1 度那 Kp 大概在 50 左右實(shí)際還要根據(jù)機(jī)械慣量調(diào)整。3. 從零搭建三環(huán)代碼結(jié)構(gòu)與調(diào)度邏輯3.1 工程文件組織與初始化順序拿到這份資源后我習(xí)慣先看它的文件結(jié)構(gòu)。通常會有foc_core.c、pid.c、svpwm.c、encoder.c這幾個核心文件外加一個main.c做調(diào)度。初始化順序很重要先初始化時鐘和 GPIO再初始化 ADC 和 PWM然后初始化編碼器接口最后使能中斷。如果順序錯了比如先開中斷再初始化 ADC第一次中斷觸發(fā)時 ADC 還沒準(zhǔn)備好讀回來的電流就是垃圾值電機(jī)可能直接抖一下。// 初始化順序示例每一步都不能省 void System_Init(void) { Clock_Init(); // 系統(tǒng)時鐘決定 PWM 頻率 GPIO_Init(); // 引腳復(fù)用PWM 和 ADC 通道 ADC_Init(); // 電流采樣校準(zhǔn)零點(diǎn) PWM_Init(); // 中心對齊模式死區(qū)時間 Encoder_Init(); // 編碼器接口或霍爾捕獲 PID_Init(); // 三個環(huán)的 PID 參數(shù)初始化 Enable_Interrupts(); // 最后開中斷 }ADC_Init里一定要做零點(diǎn)校準(zhǔn)因?yàn)檫\(yùn)放有失調(diào)電壓。校準(zhǔn)方法是在 PWM 輸出關(guān)閉時采多次電流取平均值作為零點(diǎn)偏移。這個偏移不校準(zhǔn)電流環(huán)的積分項(xiàng)會一直累加電機(jī)不轉(zhuǎn)的時候電流采樣值都不是零。3.2 中斷調(diào)度與三環(huán)執(zhí)行頻率三環(huán)的執(zhí)行頻率決定了整個系統(tǒng)的實(shí)時性。這份資源里電流環(huán)放在 PWM 中斷里PWM 頻率 20 kHz電流環(huán)就是 20 kHz。速度環(huán)放在一個 1 kHz 的定時器中斷里位置環(huán)放在 100 Hz 的任務(wù)里。這種安排的原因是電流環(huán)需要和 PWM 同步速度環(huán)和位置環(huán)對實(shí)時性要求沒那么高放在低優(yōu)先級中斷里可以節(jié)省 CPU。// PWM 中斷服務(wù)函數(shù)電流環(huán)在這里執(zhí)行 void PWM_IRQHandler(void) { // 清除中斷標(biāo)志 PWM_ClearFlag(); // 讀取三相電流 float ia ADC_ReadPhaseA(); float ib ADC_ReadPhaseB(); float ic -ia - ib; // 基爾霍夫電流定律 // Clarke 變換 float ialpha ia; float ibeta (ia 2*ib) * ONE_BY_SQRT3; // Park 變換需要電角度 float theta Encoder_GetElecAngle(); float id ialpha * cosf(theta) ibeta * sinf(theta); float iq -ialpha * sinf(theta) ibeta * cosf(theta); // 電流環(huán) PI float vd PI_Update(pid_id, id_ref - id); float vq PI_Update(pid_iq, iq_ref - iq); // 反 Park 變換和 SVPWM SVPWM_Output(vd, vq, theta); }這段代碼里Encoder_GetElecAngle返回的是電角度不是機(jī)械角度。電角度等于機(jī)械角度乘以極對數(shù)這個換算在編碼器初始化時就要算好。如果極對數(shù)填錯電機(jī)要么不轉(zhuǎn)要么轉(zhuǎn)起來力矩很小。我見過有人把 7 對極的電機(jī)填成 4 對極結(jié)果電流環(huán)完全失控電機(jī)嗡嗡響但不轉(zhuǎn)。3.3 參數(shù)整定的實(shí)操步驟整定三環(huán)參數(shù)不能同時調(diào)必須從內(nèi)到外。先把速度環(huán)和位置環(huán)的輸出限幅設(shè)為零只讓電流環(huán)工作給 Iq_ref 一個階躍信號看電流波形。如果電流上升太慢增大 Kp如果電流超調(diào)大或者振蕩減小 Kp 或增大 Ki。電流環(huán)調(diào)好后把速度環(huán)輸出限幅放開給速度參考一個階躍調(diào)速度環(huán)的 Kp 和 Ki。最后調(diào)位置環(huán)。提示每次只調(diào)一個參數(shù)調(diào)完記錄波形不要憑感覺同時改好幾個參數(shù)否則出了問題根本不知道是哪個參數(shù)引起的。速度環(huán)整定時如果電機(jī)出現(xiàn)低頻振蕩通常是速度環(huán) Kp 太大如果轉(zhuǎn)速跌落恢復(fù)太慢是 Ki 太小。位置環(huán)如果到達(dá)目標(biāo)后來回晃是 Kp 太大或者沒有加死區(qū)。這份資源里每個環(huán)都有獨(dú)立的調(diào)試接口可以通過串口實(shí)時修改參數(shù)不用重新燒錄程序。4. 避坑與排查三環(huán)調(diào)試中最容易翻車的五個點(diǎn)4.1 電流采樣零點(diǎn)漂移導(dǎo)致積分飽和現(xiàn)象電機(jī)上電后不轉(zhuǎn)但電流采樣值一直在緩慢增大過幾秒后過流保護(hù)觸發(fā)。 原因運(yùn)放失調(diào)電壓隨溫度變化零點(diǎn)校準(zhǔn)只在初始化時做了一次運(yùn)行中漂移了。 解決在 PWM 中斷里定期更新零點(diǎn)比如每 100 次中斷取一次當(dāng)前電流作為新的零點(diǎn)但要在電機(jī)停轉(zhuǎn)時做?；蛘哂糜布\(yùn)放加調(diào)零電路。4.2 電角度對齊錯誤導(dǎo)致力矩不足現(xiàn)象電機(jī)能轉(zhuǎn)但帶載能力只有額定的一半電流波形畸變。 原因編碼器安裝偏差或者極對數(shù)填錯導(dǎo)致 Park 變換用的電角度和實(shí)際轉(zhuǎn)子位置差了一個固定角度。 解決做電角度對齊給 d 軸一個固定電壓讓轉(zhuǎn)子轉(zhuǎn)到 d 軸方向然后強(qiáng)制把編碼器角度清零。這份資源里有一個對齊函數(shù)調(diào)用一次就能自動完成。4.3 速度環(huán)反饋濾波過度導(dǎo)致響應(yīng)遲滯現(xiàn)象電機(jī)突加負(fù)載時轉(zhuǎn)速跌落很大恢復(fù)很慢但電流環(huán)響應(yīng)正常。 原因速度環(huán)反饋的低通濾波器截止頻率設(shè)得太低速度信號被嚴(yán)重滯后。 解決把濾波器截止頻率提高到速度環(huán)帶寬的 3 倍以上或者改用滑動平均濾波延遲更小。4.4 位置環(huán)積分項(xiàng)導(dǎo)致過沖現(xiàn)象位置指令給一個階躍電機(jī)沖過目標(biāo)位置再彈回來。 原因位置環(huán)用了 PI 控制積分項(xiàng)在接近目標(biāo)時還在累加。 解決位置環(huán)只用 P 控制或者給積分項(xiàng)加一個條件只在誤差大于某個閾值時才累加。4.5 中斷優(yōu)先級沖突導(dǎo)致電流環(huán)丟步現(xiàn)象電機(jī)高速運(yùn)行時偶爾出現(xiàn)咔噠聲電流波形有毛刺。 原因速度環(huán)中斷優(yōu)先級高于電流環(huán)速度環(huán)執(zhí)行時間過長時打斷了電流環(huán)。 解決把電流環(huán)中斷設(shè)為最高優(yōu)先級速度環(huán)和位置環(huán)設(shè)為低優(yōu)先級。如果 MCU 支持把速度環(huán)和位置環(huán)放到主循環(huán)里輪詢不用中斷。5. 進(jìn)階技巧用示波器和串口波形驗(yàn)證三環(huán)性能調(diào)三環(huán)最怕的就是“盲調(diào)”改一個參數(shù)不知道好壞。我一般會同時用兩個手段示波器看電流波形串口上位機(jī)看速度響應(yīng)曲線。這份資源里預(yù)留了一個 DAC 輸出接口可以把 Id、Iq 或者速度值實(shí)時輸出到示波器上。如果沒有 DAC就用串口每隔 1 ms 發(fā)一次數(shù)據(jù)上位機(jī)畫波形。// 串口發(fā)送波形數(shù)據(jù)格式Id, Iq, Speed, Position void Send_Waveform(void) { static uint32_t last_tick 0; if (GetTick() - last_tick 1) return; // 1ms 發(fā)送一次 last_tick GetTick(); printf(%.3f,%.3f,%.1f,%.2f\n, foc.id, foc.iq, foc.speed_rpm, foc.position_deg); }上位機(jī)用常見的串口波形軟件就行把數(shù)據(jù)解析成四通道。看電流環(huán)時給 Iq_ref 一個方波觀察 Iq 的實(shí)際跟蹤上升時間應(yīng)該在 1 ms 以內(nèi)超調(diào)小于 10%。看速度環(huán)時給速度參考一個階躍觀察轉(zhuǎn)速上升時間和跌落恢復(fù)時間。位置環(huán)看階躍響應(yīng)的過沖和穩(wěn)定時間。注意串口發(fā)送數(shù)據(jù)會占用 CPU 時間如果電流環(huán)頻率很高不要在電流環(huán)中斷里發(fā)串口放在低優(yōu)先級任務(wù)里。還有一個技巧是注入一個小的正弦擾動到 Iq_ref 上然后用示波器看 Iq 的響應(yīng)可以測出電流環(huán)的帶寬。如果帶寬低于 500 Hz說明 Kp 太小或者 PWM 頻率太低。我一般會把 PWM 頻率設(shè)在 16 kHz 以上這樣電流環(huán)帶寬能做到 1 kHz 以上電機(jī)聲音也人耳聽不到。從那以后我每次調(diào)新電機(jī)都強(qiáng)制走一遍“先電流環(huán)、再速度環(huán)、最后位置環(huán)”的順序絕不跳步。希望幫到你。本文還有配套的精品資源點(diǎn)擊獲取