化：從ADC觸發(fā)到DMA搬運的完整實踐)
做FOC的兄弟如果你點進(jìn)這篇文章大概率是被那幾行“看起來沒問題跑起來就炸”的電流采集代碼折磨過。這個系列我已經(jīng)寫到第11篇了前幾篇聊了任務(wù)調(diào)度、內(nèi)存池、log開銷這些通用優(yōu)化手段今天專門落到一個非常具體的場景上一段跑在STM32或類似MCU上的FOC電流采集程序怎么把它從“能跑”優(yōu)化到“抗干擾、低延遲、CPU占用低”。這篇文章我會按照自己實際調(diào)試的路徑來寫——先看原始代碼有哪些壞味道再用工具量化瓶頸然后給出整套優(yōu)化方案最后是踩坑記錄。不聊虛的每一步都對著代碼和時間數(shù)字說話。1. FOC電流采集性能優(yōu)化的前置認(rèn)知1.1 電流采集在FOC環(huán)路里的核心地位FOC說到底就是一個“觀電流-換坐標(biāo)系-算電壓矢量”的閉環(huán)。Clark變換把三相電流采樣值投影到靜止坐標(biāo)系Park變換再把它轉(zhuǎn)到旋轉(zhuǎn)坐標(biāo)系得到id和iq然后過電流環(huán)PID反Park變換生成電壓矢量最后SVPWM輸出給逆變器。這套鏈路里第一環(huán)就是電流采集。電流采集慢半拍整個電流環(huán)的相角裕度就會下降。具體來說電流環(huán)的延遲直接加進(jìn)系統(tǒng)的相位滯后里。如果你采樣延遲從2微秒漲到10微秒在20kHz電流環(huán)下相當(dāng)于把系統(tǒng)相位裕度拖掉了大約9度左右。如果原來就只留了30到40度裕度這9度延遲完全可能讓電機從“穩(wěn)”變成“嘯叫”甚至“炸管”。我見過不少現(xiàn)場問題電機跑起來低速抖、高速嘯排查了半天不是PID沒調(diào)好而是電流采樣的時機和耗時根本不對。所以做FOC性能優(yōu)化第一個要動的就是電流采集。1.2 為什么電流采樣要放在下橋熱搜詞里有個高頻問題FOC電流采集為什么都要設(shè)置在下橋這個要結(jié)合三相逆變器的開關(guān)狀態(tài)來理解。FOC常用的是雙電阻或三電阻采樣方案。雙電阻方案里采樣電阻串在下橋臂MOSFET的源極和地之間只能在下管導(dǎo)通的時刻采集到對應(yīng)的相電流。因為上管導(dǎo)通的時候相電流走的是母線上管到電機繞組的路徑不經(jīng)過下橋采樣電阻你根本量不到東西。具體到“什么時候采”這個點業(yè)內(nèi)通用做法是在PWM中心對齊模式的定時器上溢或下溢時刻觸發(fā)ADC。因為在這個時刻三相下橋全部處于導(dǎo)通狀態(tài)至少也要避開死區(qū)和窄脈寬的坑采樣電阻上有完整的相電流流過采集到的值最穩(wěn)定。所以“下橋采樣”不是工程師拍腦袋定的而是由電流物理路徑和SVPWM開關(guān)狀態(tài)共同決定的。你只要理解了這一點后面配置ADC觸發(fā)時就不會擰巴。1.3 性能優(yōu)化前先搞清楚要優(yōu)化什么指標(biāo)看性能永遠(yuǎn)先定義指標(biāo)。對于FOC電流采集代碼我主要關(guān)注下面三個數(shù)字。第一是CPU占用率。電流環(huán)中斷如果每50微秒跑一次一次執(zhí)行10微秒那就是20%的CPU花在了電流環(huán)上。如果還能壓到3微秒就能省出大量CPU給上位機通信、觀測器或者其他控制任務(wù)。第二是采樣延遲也就是從“電流真實流過采樣電阻”到“電流環(huán)拿到這個數(shù)據(jù)”的時間差。這個延遲包含ADC轉(zhuǎn)換時間、搬運時間、濾波時間和坐標(biāo)變換時間。門檻就是剛才說的延遲越小相位裕度越充足。第三是采樣噪聲和抖動。ADC觸發(fā)的時刻抖動會導(dǎo)致采樣值抖動如果抖動和電機的電磁噪聲疊加你最后看到的電流波形就是一團毛刺。這會影響電流環(huán)質(zhì)量也會讓轉(zhuǎn)速波動變大。這三個指標(biāo)互相牽制。CPU占用下去了如果采樣時刻飄了也是白搭。所以優(yōu)化不是單一維度而是整套鏈路一起優(yōu)化。2. 原始代碼的壞味道與性能基線測量2.1 一段很典型的“能用但難受”采集代碼為了說明問題我把一份常見的電流采集代碼簡化后放在下面。這段代碼雜糅了STM32標(biāo)準(zhǔn)庫和部分HAL風(fēng)格真實項目里往往比這個更亂。// 電流環(huán)中斷PWM下溢觸發(fā)頻率20kHz void TIM_UP_IRQHandler(void) { // 手動觸發(fā)ADC轉(zhuǎn)換然后死等結(jié)果 ADC1_StartConversion(); while (!ADC1_GetFlagStatus(ADC1_FLAG_EOC)) ; // 阻塞等待 int16_t adc_val[2]; adc_val[0] ADC1_GetValue(); ADC1_StartConversion(); while (!ADC1_GetFlagStatus(ADC1_FLAG_EOC)) ; adc_val[1] ADC1_GetValue(); // 換算實際電流值 float ia (float)adc_val[0] * K_SCALE - I_BIAS; float ib (float)adc_val[1] * K_SCALE - I_BIAS; float ic -(ia ib); // 低通濾波用的還是double static double ia_flt 0.0, ib_flt 0.0; ia_flt ia_flt * 0.9 (double)ia * 0.1; ib_flt ib_flt * 0.9 (double)ib * 0.1; // Clark變換 float i_alpha ia_flt; float i_beta (ia_flt 2.0f * ib_flt) * 0.57735027f; // Park變換用了正弦和余弦?guī)旌瘮?shù) float sin_t sinf(theta); float cos_t cosf(theta); float id i_alpha * cos_t i_beta * sin_t; float iq -i_alpha * sin_t i_beta * cos_t; // 電流環(huán)PID省略中間代碼 pid_id_run(pid_id, id, id_ref); pid_iq_run(pid_iq, iq, iq_ref); // 更新SVPWM比較值 svpwm_update(); }你第一眼看這段代碼可能覺得“該做的都做了”但真正跑起來就發(fā)現(xiàn)問題很多。最大的問題是阻塞等待ADC轉(zhuǎn)換STM32F103這類MCU的ADC單次轉(zhuǎn)換大約1微秒到幾微秒不等如果你每個PWM周期要采兩路一路等一次光這一項就吃掉好幾微秒。第二個問題是中斷里做低通濾波而且用的double在Cortex-M3/M4上double運算比float慢不少。第三是Park變換里的sinf和cosf雖然加了f后綴但庫函數(shù)還是在中斷里跑了幾百個周期。這些問題單看每一項好像都“還好”累積起來就比較致命。我們實測過這段代碼在一顆72MHz的Cortex-M3上跑一個20kHz中斷的執(zhí)行時間能到13.8微秒CPU占用率27.6%。電機不轉(zhuǎn)的時候沒問題一旦帶上負(fù)載電流波形毛刺明顯電機噪音也大。2.2 用IO翻轉(zhuǎn)和邏輯分析儀測性能基線不測量就沒有優(yōu)化。每寫一段優(yōu)化代碼之前我都會先在中斷入口和出口拉高拉低一個測試IO用邏輯分析儀看高電平時間寬度。這個方法土但非常有效能干到幾十納秒的精度。測法很簡單進(jìn)中斷先GPIO置高出中斷前GPIO置低邏輯分析儀采樣率設(shè)到100MHz以上抓幾個PWM周期高電平時間就是中斷執(zhí)行耗時。當(dāng)時測出的數(shù)據(jù)大致是項目數(shù)值PWM頻率20kHz周期50微秒中斷平均執(zhí)行時間13.8微秒中斷最大執(zhí)行時間15.2微秒CPU占用率27.6%ADC觸發(fā)方式軟件手動觸發(fā)阻塞等待采樣抖動峰峰值約±1.2微秒看到采樣抖動這行你可能就明白了為什么這個電機低速時會有周期性的噪聲。因為電流采樣點前后飄了1微秒以上在正弦波電流的過零點附近這個時間偏移對應(yīng)不小的電流誤差。這誤差進(jìn)了電流環(huán)等于給系統(tǒng)加了一個隨機擾動。2.3 明確瓶頸優(yōu)先級先時序后算法面對這段代碼我曾經(jīng)也想過先把sinf換掉、把double換float但實測發(fā)現(xiàn)這些還不是關(guān)鍵。核心瓶頸是先“什么時候采”的問題沒解決。軟件觸發(fā)ADC意味著你必須等ADC轉(zhuǎn)換完才能做下一步。你永遠(yuǎn)不知道前一次中斷里的其他代碼是不是拖沓了導(dǎo)致這次ADC觸發(fā)晚了。這個機制本質(zhì)上是串行依賴的天生就會引入抖動。所以第一優(yōu)先級是改采樣觸發(fā)方式把ADC觸發(fā)從“軟件觸發(fā)輪詢等待”改成“硬件定時觸發(fā)DMA搬運”。這樣ADC轉(zhuǎn)換和CPU計算可以在時間上重疊起來。等CPU真正拿到數(shù)據(jù)的時候ADC已經(jīng)把該轉(zhuǎn)的都轉(zhuǎn)完了。算法層面的優(yōu)化像濾波、坐標(biāo)變換可以放到后面做。先把時序理順往往能解決一大半問題。3. 優(yōu)化方案逐步落地從ADC觸發(fā)到DMA搬運3.1 用定時器硬件觸發(fā)ADC替代軟件觸發(fā)針對上面的痛點第一步就是把ADC改成由定時器主動觸發(fā)。STM32的高級定時器TIM1或TIM8在PWM輸出模式上有個很方便的特性可以配置為在中心對齊計數(shù)的上溢或下溢事件時輸出一個觸發(fā)信號給ADC。這樣ADC采樣就和PWM載波嚴(yán)格同步了不需要軟件干預(yù)。SVPWM的中心對齊模式下定時器計數(shù)值先增后減遞減到0的時刻下溢正好是三相下橋全部導(dǎo)通的窗口中心在這里觸發(fā)ADC采樣是最理想的。配置的核心代碼大致長這樣// 以STM32F407為例使用TIM1的TRGO觸發(fā)ADC1 TIM_SelectOutputTrigger(TIM1, TIM_TRGO_UPDATE); // 或者根據(jù)需求用TIM_TRGO_CC1IF等事件 ADC_InitTypeDef adc_init; // ADC獨立模式12位采樣時間盡量短但保證充足 adc_init.ADC_Mode ADC_Mode_Independent; adc_init.ADC_ExternalTrigConv ADC_ExternalTrigConv_T1_TRGO; adc_init.ADC_ExternalTrigConvEdge ADC_ExternalTrigConvEdge_Rising; adc_init.ADC_Resolution ADC_Resolution_12b; // 其他配置略配置好以后你每次PWM周期內(nèi)不需要再調(diào)用ADC1_StartConversion()ADC硬件會在定時器事件到來時自動啟動轉(zhuǎn)換。這里有個細(xì)節(jié)觸發(fā)邊沿要選對。如果你的定時器配置為上溢和下溢都會更新那就需要根據(jù)實際配置選擇沿。常用的做法是配置成僅在向下計數(shù)到0時觸發(fā)一次這樣每個PWM周期只采樣一次。如果你的電流環(huán)需要每個周期采集兩次比如在某些特殊工況下需要兩個矢量作用時刻的電流用于低調(diào)制比下的重構(gòu)再改成雙觸發(fā)。3.2 打開ADC的DMA模式讓數(shù)據(jù)自動搬運光靠硬件觸發(fā)還不夠因為轉(zhuǎn)換完成標(biāo)志還是要軟件去查。此時引入DMA就順理成章了。ADC每個通道轉(zhuǎn)換完成后DMA會自動把數(shù)據(jù)從ADC的數(shù)據(jù)寄存器搬到內(nèi)存數(shù)組里不需要CPU參與搬運。配置DMA的要點有兩個一是工作在循環(huán)模式這樣每個PWM周期DMA都會自動搬運一組新數(shù)據(jù)永遠(yuǎn)不用重裝二是數(shù)據(jù)長度要和ADC通道數(shù)對齊。DMA_InitTypeDef dma_init; dma_init.DMA_Channel DMA_Channel_0; // ADC1對應(yīng)DMA2 Stream0按芯片手冊選 dma_init.DMA_PeripheralBaseAddr (uint32_t)ADC1-DR; dma_init.DMA_Memory0BaseAddr (uint32_t)adc_buffer; dma_init.DMA_DIR DMA_DIR_PeripheralToMemory; dma_init.DMA_BufferSize 2; // 兩路電流采樣 dma_init.DMA_Mode DMA_Mode_Circular; // 循環(huán)模式 dma_init.DMA_PeripheralInc DMA_PeripheralInc_Disable; dma_init.DMA_MemoryInc DMA_MemoryInc_Enable; dma_init.DMA_PeripheralDataSize DMA_PeripheralDataSize_HalfWord; dma_init.DMA_MemoryDataSize DMA_MemoryDataSize_HalfWord; dma_init.DMA_Priority DMA_Priority_High; dma_init.DMA_FIFOMode DMA_FIFOMode_Disable;DMA模式下CPU完全不用等ADC。電流環(huán)中斷觸發(fā)時直接讀adc_buffer[0]和adc_buffer[1]即可。注意要用volatile修飾緩沖數(shù)組否則編譯器可能在優(yōu)化時把兩次讀數(shù)組重排或直接緩存到寄存器里讀到舊數(shù)據(jù)。內(nèi)核里有一個非常反直覺的坑——你讀DMA緩沖時DMA可能正好在搬運新數(shù)據(jù)。雖然循環(huán)模式下ADC的兩個通道是順序轉(zhuǎn)換的但如果你在PWM中斷里讀到的兩路數(shù)據(jù)分別屬于兩個不同的PWM周期那你用來算Clark變換的ia和ib就不是同一時刻的電流值會產(chǎn)生額外的相位誤差。解決辦法有兩個要么在PWM中斷里讀數(shù)據(jù)時先關(guān)DMA再讀再開DMA這種方法如果操作不當(dāng)會丟失一個觸發(fā)事件不一定好要么配置ADC為注入組單次掃描模式用注入組轉(zhuǎn)換結(jié)束事件觸發(fā)中斷保證兩個通道是同一批次轉(zhuǎn)換出來的。我個人更推薦后者因為它從機制上保證了兩個值的時間一致性。3.3 電流環(huán)中斷瘦身只留真正必要的計算硬件觸發(fā)和DMA解決的問題是“采集過程不占用CPU時間”。但中斷里仍然存在一些不合理的計算。先看濾波部分。有些工程師習(xí)慣把低通濾波放在中斷里但我們得想清楚FOC電流環(huán)本身就是一個帶寬很高的環(huán)路你砍掉高頻噪聲是可以的但如果濾波太深會把有用信號也削掉。比如你用0.1的系數(shù)做低通等效帶寬可能已經(jīng)低于電流環(huán)帶寬了這會導(dǎo)致相位延遲增大。更穩(wěn)妥的做法是如果ADC采樣毛刺不是特別嚴(yán)重直接用硬件層面優(yōu)化。比如把ADC采樣時間從1.5周期加到3個周期讓采樣電容充分充電毛刺往往就下來了。實在需要軟件濾波優(yōu)先用一階IIR系數(shù)選0.7到0.9之間別低于0.7。再來看坐標(biāo)變換時的sinf和cosf。我理解很多人圖省事直接用數(shù)學(xué)庫但它的實現(xiàn)里包含精度和兼容性考慮往往不是最快的。FOC里角度theta的變化是有規(guī)律可循的在很多項目里可以把sin/cos表做成512點甚至1024點的查找表查表加線性插值的誤差足夠小速度卻快很多。3.4 用查表替代實時三角函數(shù)計算舉一個具體例子。假設(shè)電機最高電頻率是500HzPWM頻率20kHz也就是每個電周期有40個PWM周期。如果用512點sin表每次查表之間角度步進(jìn)是360/512約等于0.7度對電流環(huán)來說精度已經(jīng)足夠好了。查表法實現(xiàn)如下#define SIN_TABLE_SIZE 512 #define SIN_TABLE_MASK (SIN_TABLE_SIZE - 1) // 建表時一次性算好 static float sin_table[SIN_TABLE_SIZE]; void sin_table_init(void) { for (int i 0; i SIN_TABLE_SIZE; i) { sin_table[i] sinf(2.0f * PI * i / SIN_TABLE_SIZE); } } // 查表線性插值 float fast_sin(float angle_rad) { float index_f angle_rad * (SIN_TABLE_SIZE / (2.0f * PI)); int32_t index (int32_t)index_f; float frac index_f - (float)index; index SIN_TABLE_MASK; int32_t index_next (index 1) SIN_TABLE_MASK; return sin_table[index] (sin_table[index_next] - sin_table[index]) * frac; }實際項目中這個查表函數(shù)在Cortex-M4上大概幾十個周期就能跑完比sinf快一半還多。3.5 電流環(huán)代碼抽離緊急任務(wù)和非緊急任務(wù)分開電流環(huán)中斷里除了坐標(biāo)變換和PID往往還混著一些不太相關(guān)的東西。比如有的工程師會把轉(zhuǎn)速估算、弱磁控制、過流保護(hù)邏輯全塞在一個中斷里。這類問題在優(yōu)化時要拆開。FOC中真正需要和PWM同頻執(zhí)行的部分只有電流采樣讀取、坐標(biāo)變換、電流環(huán)PID、SVPWM輸出。這些都是必須在載波周期內(nèi)完成的“緊急任務(wù)”。轉(zhuǎn)速估算這類東西很多時候不需要20kHz的頻率。如果你的目標(biāo)帶寬在100Hz左右那么轉(zhuǎn)速估算哪怕降到1kHz也沒有問題。把它挪到低優(yōu)先級定時中斷或者主循環(huán)里跑能大幅減輕高頻中斷的負(fù)擔(dān)。過流保護(hù)必須走硬件比較器或ADC模擬看門狗這是硬件級別的快速保護(hù)不能讓軟件延遲決定是否炸MOS管。軟件層面的過流檢測可以作為第二道防線不要把它和電流環(huán)PID混在同一個中斷里。3.6 把高頻中斷放到RAM里執(zhí)行這個優(yōu)化點知道的人不算多但在Flash速度慢的MCU上非常有效。很多MCU從Flash取指令是有等待周期的尤其是高頻時鐘下。比如STM32F4在168MHz主頻下Flash等待周期可能到5個周期這意味著每條指令都要多等好幾個周期。解決辦法是直接把電流環(huán)中斷服務(wù)函數(shù)放進(jìn)RAM執(zhí)行。GCC環(huán)境下用__attribute__((section(.ramfunc)))即可IAR則用__ramfunc關(guān)鍵字。__attribute__((section(.ramfunc))) void TIM1_UP_IRQHandler(void) { // 快速執(zhí)行電流環(huán) }注意這段函數(shù)會被拷貝到RAM里運行如果RAM緊張就不能放太多內(nèi)容。實際項目中我通常只把最關(guān)鍵的電流環(huán)ISR放進(jìn)去其他普通中斷保持原地不動。4. 優(yōu)化后的代碼長什么樣4.1 結(jié)構(gòu)清晰的電流環(huán)主流程經(jīng)過了上面幾步的優(yōu)化電流環(huán)中斷的代碼就清爽多了。下面是我在項目中實際使用過的簡化版本// 電流環(huán)中斷TIM1下溢硬件觸發(fā)ADCDMA搬運 __attribute__((section(.ramfunc))) void TIM1_UP_IRQHandler(void) { adc_dma_buffer_t adc read_adc_buffer(); // 原始電流還原 float ia adc.sample_a * K_SCALE - I_BIAS; float ib adc.sample_b * K_SCALE - I_BIAS; float ic -(ia ib); // 可選的弱濾波只在必要時啟用 ia iir_lpf(ia, filter_a_state); ib iir_lpf(ib, filter_b_state); // Clark變換 i_alpha ia; i_beta (ia 2.0f * ib) * SQRT1_3; // Park變換查表法 float s fast_sin(theta), c fast_cos(theta); id i_alpha * c i_beta * s; iq -i_alpha * s i_beta * c; // 電流環(huán)PID pid_id_run(pid_id, id, id_ref); pid_iq_run(pid_iq, iq, iq_ref); // 反Park變換 vd id_out * c - iq_out * s; vq id_out * s iq_out * c; // SVPWM輸出 svpwm_apply(vd, vq); }這段代碼的精髓在于數(shù)據(jù)已經(jīng)從DMA那準(zhǔn)備好了濾波函數(shù)做了輕量化三角函數(shù)用查表整個中斷里沒有阻塞等待沒有多余的判斷分支。你甚至可以把這段代碼的執(zhí)行時間控制得很穩(wěn)定這對FOC控制的一致性非常重要。4.2 ADC配置代碼的完整示例光看中斷代碼還不夠ADC和DMA的初始化也要配套。這里給一個相對完整的STM32F4系列初始化參考。void foc_adc_init(void) { ADC_InitTypeDef adc_init; DMA_InitTypeDef dma_init; GPIO_InitTypeDef gpio_init; NVIC_InitTypeDef nvic_init; // 使能ADC1時鐘和GPIO時鐘 RCC_APB2PeriphClockCmd(RCC_APB2Periph_ADC1, ENABLE); RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_DMA2 | RCC_AHB1Periph_GPIOC, ENABLE); // PC0和PC1作為模擬輸入對應(yīng)ADC1的通道10和通道11 gpio_init.GPIO_Pin GPIO_Pin_0 | GPIO_Pin_1; gpio_init.GPIO_Mode GPIO_Mode_AN; gpio_init.GPIO_PuPd GPIO_PuPd_NOPULL; GPIO_Init(GPIOC, gpio_init); // DMA2 Stream0配置 dma_init.DMA_Channel DMA_Channel_0; dma_init.DMA_PeripheralBaseAddr (uint32_t)ADC1-DR; dma_init.DMA_Memory0BaseAddr (uint32_t)foc_adc_dma_buffer; dma_init.DMA_DIR DMA_DIR_PeripheralToMemory; dma_init.DMA_BufferSize 2; dma_init.DMA_PeripheralInc DMA_PeripheralInc_Disable; dma_init.DMA_MemoryInc DMA_MemoryInc_Enable; dma_init.DMA_PeripheralDataSize DMA_PeripheralDataSize_HalfWord; dma_init.DMA_MemoryDataSize DMA_MemoryDataSize_HalfWord; dma_init.DMA_Priority DMA_Priority_High; dma_init.DMA_Mode DMA_Mode_Circular; DMA_Init(DMA2_Stream0, dma_init); // ADC1配置 adc_init.ADC_Mode ADC_Mode_Independent; adc_init.ADC_ScanConvMode ENABLE; // 掃描模式多通道 adc_init.ADC_ContinuousConvMode DISABLE; // 超時觸發(fā)不是連續(xù)轉(zhuǎn)換 adc_init.ADC_ExternalTrigConvEdge ADC_ExternalTrigConvEdge_Rising; adc_init.ADC_ExternalTrigConv ADC_ExternalTrigConv_T1_TRGO; // TIM1觸發(fā) adc_init.ADC_DataAlign ADC_DataAlign_Right; adc_init.ADC_NbrOfConversion 2; ADC_Init(ADC1, adc_init); // 配置兩個通道的采樣時間 ADC_RegularChannelConfig(ADC1, ADC_Channel_10, 1, ADC_SampleTime_3Cycles); ADC_RegularChannelConfig(ADC1, ADC_Channel_11, 2, ADC_SampleTime_3Cycles); // 使能DMA和ADC ADC_DMACmd(ADC1, ENABLE); ADC_Cmd(ADC1, ENABLE); }初始化代碼里需要注意的一個細(xì)節(jié)是掃描模式下ADC的通道順序就決定DMA緩沖里的數(shù)據(jù)順序。你必須清楚通道10對應(yīng)dma_buffer[0]通道11對應(yīng)dma_buffer[1]后面讀數(shù)據(jù)時別搞反。4.3 優(yōu)化后的性能參數(shù)實測代碼改完之后我用同樣的邏輯分析儀測了一輪結(jié)果對比如下指標(biāo)優(yōu)化前優(yōu)化后中斷平均執(zhí)行時間13.8微秒4.2微秒中斷最大執(zhí)行時間15.2微秒4.5微秒CPU占用率20kHz中斷27.6%8.4%采樣抖動峰峰值±1.2微秒±0.15微秒電流波形毛刺明顯帶載時噪聲大基本消除CPU占用從27.6%降到8.4%直接省出了19個百分點的算力。這個余量你可以用來做無傳感器觀測器、做在線參數(shù)辨識或者干脆降低主頻以省電。采樣抖動從1.2微秒壓到0.15微秒電機低速時的周期性噪聲基本消失。5. 高頻FOC工程中的常見問題清單5.1 采樣點正好落在死區(qū)或者窄脈寬區(qū)間電流采集要避開死區(qū)時間否則采樣出來的電流不是真實相電流。這個問題在做小占空比、低調(diào)制比工況時尤其容易踩。SVPWM載波中心的下橋?qū)ù翱谌绻瑼DC采樣時刻稍微偏一點就可能采到死區(qū)期間的回流狀態(tài)。解決思路是加入最小采樣窗口判斷。比如計算當(dāng)前PWM周期的有效下橋?qū)〞r間如果低于某個閾值比如3微秒就放棄本輪采樣用上一次的電流值或者把ADC觸發(fā)點往安全方向偏移。5.2 電流過采樣濾波后出現(xiàn)了額外相位延遲有些工程師為了讓波形更干凈喜歡把多個PWM周期內(nèi)的電流采樣值做平均。比如四周期滑動平均這在軟件上很好寫但效果不一定好。因為滑動平均本質(zhì)是一個FIR濾波器它本身會引入大約1.5個采樣周期的延遲。在電流環(huán)里這個延遲直接轉(zhuǎn)化為相位滯后。我見過有人把滑動窗口加到八個點結(jié)果電機跑高速時電流環(huán)開始振蕩。濾波不是越強越好做電流環(huán)濾波時一定要拿示波器看階躍響應(yīng)確認(rèn)沒有額外相移。5.3 DMA循環(huán)模式下讀到了“半新半舊”的數(shù)據(jù)這個問題我在3.2節(jié)提了一些實際項目中經(jīng)常讓人頭疼。DMA循環(huán)模式是永遠(yuǎn)在跑的你讀數(shù)組的時候數(shù)組里面可能既有前一周期數(shù)據(jù)又有本周期的數(shù)據(jù)。這在ADC掃描模式配置不當(dāng)?shù)臅r候尤其明顯。我的建議是果斷使用注入組轉(zhuǎn)換。注入組轉(zhuǎn)換可以配置為一次轉(zhuǎn)換一組通道并把結(jié)果鎖存到注入數(shù)據(jù)寄存器里。這樣讀到的兩個值才是嚴(yán)格同一時刻的快照不需要用開關(guān)DMA這種粗糙的規(guī)避方案。5.4 PFC和電機驅(qū)動共用MCU時中斷優(yōu)先級怎么定很多項目是一個MCU同時管PFC和電機FOC。PFC通常也是高頻控制兩個電流環(huán)中斷優(yōu)先級一旦配錯系統(tǒng)就會出現(xiàn)奇怪的震蕩。一個基本準(zhǔn)則是哪個環(huán)路帶寬高、故障風(fēng)險大哪個優(yōu)先級就高。FOC的過流風(fēng)險更大通常FOC電流環(huán)中斷優(yōu)先于PFC。PFC的電流環(huán)如果稍微滯后一拍一般不會炸機但FOC的電流環(huán)滯后就會導(dǎo)致電流失控。5.5 在中斷里不要用printf這條聽著像廢話但真的有人踩坑。FOC電流環(huán)20kHz頻率下你要是往中斷里塞一個printf哪怕是重定向到數(shù)組緩存也會大量占用CPU時間甚至把中斷棧頂爆掉。調(diào)試的時候可以用IO翻轉(zhuǎn)邏輯分析儀或者DMA串口輸出少量關(guān)鍵變量不要用阻塞式的printf。真要看波形把變量存到一個環(huán)形緩沖區(qū)然后讓上位機通過慢速通道慢慢讀這個通道放在主循環(huán)里執(zhí)行就行。6. 優(yōu)化思路的橫向遷移不只適用于FOC這套優(yōu)化方法并不是只能用在FOC電流采集上。數(shù)字電源的電壓電流雙環(huán)、伺服驅(qū)動的編碼器采樣、并網(wǎng)逆變器的電網(wǎng)電壓鎖相環(huán)它們本質(zhì)都是“高速外設(shè)采樣高頻控制中斷延遲敏感閉環(huán)”。你只要記住這條主線數(shù)據(jù)準(zhǔn)備盡量用硬件自動完成CPU在中斷里只做真正的控制運算最后用測量數(shù)據(jù)驗證每一個環(huán)節(jié)的開銷。哪里延遲大就把哪里往硬件卸載或者往低頻搬。我自己在數(shù)字電源項目里也復(fù)用了這套ADCDMA定時器觸發(fā)機制效果同樣明顯。所以這篇文章的內(nèi)容與其說是“FOC電流采集代碼優(yōu)化”不如說是一套嵌入式高實時性閉環(huán)的通用套路。最后說一個個人心得做這類優(yōu)化不要一上來就懷疑自己的控制算法不行。先把鏈路里每一段延遲都測出來、量出來讓數(shù)據(jù)告訴你瓶頸在哪里。大多數(shù)情況下問題根本不在PID參數(shù)而在數(shù)據(jù)通路本身。把通路理順了電流環(huán)自然就聽話了。 FOC電流采集代碼優(yōu)化：從ADC觸發(fā)到DMA搬運的完整實踐
做FOC的兄弟如果你點進(jìn)這篇文章大概率是被那幾行“看起來沒問題跑起來就炸”的電流采集代碼折磨過。這個系列我已經(jīng)寫到第11篇了前幾篇聊了任務(wù)調(diào)度、內(nèi)存池、log開銷這些通用優(yōu)化手段今天專門落到一個非常具體的場景上一段跑在STM32或類似MCU上的FOC電流采集程序怎么把它從“能跑”優(yōu)化到“抗干擾、低延遲、CPU占用低”。這篇文章我會按照自己實際調(diào)試的路徑來寫——先看原始代碼有哪些壞味道再用工具量化瓶頸然后給出整套優(yōu)化方案最后是踩坑記錄。不聊虛的每一步都對著代碼和時間數(shù)字說話。1. FOC電流采集性能優(yōu)化的前置認(rèn)知1.1 電流采集在FOC環(huán)路里的核心地位FOC說到底就是一個“觀電流-換坐標(biāo)系-算電壓矢量”的閉環(huán)。Clark變換把三相電流采樣值投影到靜止坐標(biāo)系Park變換再把它轉(zhuǎn)到旋轉(zhuǎn)坐標(biāo)系得到id和iq然后過電流環(huán)PID反Park變換生成電壓矢量最后SVPWM輸出給逆變器。這套鏈路里第一環(huán)就是電流采集。電流采集慢半拍整個電流環(huán)的相角裕度就會下降。具體來說電流環(huán)的延遲直接加進(jìn)系統(tǒng)的相位滯后里。如果你采樣延遲從2微秒漲到10微秒在20kHz電流環(huán)下相當(dāng)于把系統(tǒng)相位裕度拖掉了大約9度左右。如果原來就只留了30到40度裕度這9度延遲完全可能讓電機從“穩(wěn)”變成“嘯叫”甚至“炸管”。我見過不少現(xiàn)場問題電機跑起來低速抖、高速嘯排查了半天不是PID沒調(diào)好而是電流采樣的時機和耗時根本不對。所以做FOC性能優(yōu)化第一個要動的就是電流采集。1.2 為什么電流采樣要放在下橋熱搜詞里有個高頻問題FOC電流采集為什么都要設(shè)置在下橋這個要結(jié)合三相逆變器的開關(guān)狀態(tài)來理解。FOC常用的是雙電阻或三電阻采樣方案。雙電阻方案里采樣電阻串在下橋臂MOSFET的源極和地之間只能在下管導(dǎo)通的時刻采集到對應(yīng)的相電流。因為上管導(dǎo)通的時候相電流走的是母線上管到電機繞組的路徑不經(jīng)過下橋采樣電阻你根本量不到東西。具體到“什么時候采”這個點業(yè)內(nèi)通用做法是在PWM中心對齊模式的定時器上溢或下溢時刻觸發(fā)ADC。因為在這個時刻三相下橋全部處于導(dǎo)通狀態(tài)至少也要避開死區(qū)和窄脈寬的坑采樣電阻上有完整的相電流流過采集到的值最穩(wěn)定。所以“下橋采樣”不是工程師拍腦袋定的而是由電流物理路徑和SVPWM開關(guān)狀態(tài)共同決定的。你只要理解了這一點后面配置ADC觸發(fā)時就不會擰巴。1.3 性能優(yōu)化前先搞清楚要優(yōu)化什么指標(biāo)看性能永遠(yuǎn)先定義指標(biāo)。對于FOC電流采集代碼我主要關(guān)注下面三個數(shù)字。第一是CPU占用率。電流環(huán)中斷如果每50微秒跑一次一次執(zhí)行10微秒那就是20%的CPU花在了電流環(huán)上。如果還能壓到3微秒就能省出大量CPU給上位機通信、觀測器或者其他控制任務(wù)。第二是采樣延遲也就是從“電流真實流過采樣電阻”到“電流環(huán)拿到這個數(shù)據(jù)”的時間差。這個延遲包含ADC轉(zhuǎn)換時間、搬運時間、濾波時間和坐標(biāo)變換時間。門檻就是剛才說的延遲越小相位裕度越充足。第三是采樣噪聲和抖動。ADC觸發(fā)的時刻抖動會導(dǎo)致采樣值抖動如果抖動和電機的電磁噪聲疊加你最后看到的電流波形就是一團毛刺。這會影響電流環(huán)質(zhì)量也會讓轉(zhuǎn)速波動變大。這三個指標(biāo)互相牽制。CPU占用下去了如果采樣時刻飄了也是白搭。所以優(yōu)化不是單一維度而是整套鏈路一起優(yōu)化。2. 原始代碼的壞味道與性能基線測量2.1 一段很典型的“能用但難受”采集代碼為了說明問題我把一份常見的電流采集代碼簡化后放在下面。這段代碼雜糅了STM32標(biāo)準(zhǔn)庫和部分HAL風(fēng)格真實項目里往往比這個更亂。// 電流環(huán)中斷PWM下溢觸發(fā)頻率20kHz void TIM_UP_IRQHandler(void) { // 手動觸發(fā)ADC轉(zhuǎn)換然后死等結(jié)果 ADC1_StartConversion(); while (!ADC1_GetFlagStatus(ADC1_FLAG_EOC)) ; // 阻塞等待 int16_t adc_val[2]; adc_val[0] ADC1_GetValue(); ADC1_StartConversion(); while (!ADC1_GetFlagStatus(ADC1_FLAG_EOC)) ; adc_val[1] ADC1_GetValue(); // 換算實際電流值 float ia (float)adc_val[0] * K_SCALE - I_BIAS; float ib (float)adc_val[1] * K_SCALE - I_BIAS; float ic -(ia ib); // 低通濾波用的還是double static double ia_flt 0.0, ib_flt 0.0; ia_flt ia_flt * 0.9 (double)ia * 0.1; ib_flt ib_flt * 0.9 (double)ib * 0.1; // Clark變換 float i_alpha ia_flt; float i_beta (ia_flt 2.0f * ib_flt) * 0.57735027f; // Park變換用了正弦和余弦?guī)旌瘮?shù) float sin_t sinf(theta); float cos_t cosf(theta); float id i_alpha * cos_t i_beta * sin_t; float iq -i_alpha * sin_t i_beta * cos_t; // 電流環(huán)PID省略中間代碼 pid_id_run(pid_id, id, id_ref); pid_iq_run(pid_iq, iq, iq_ref); // 更新SVPWM比較值 svpwm_update(); }你第一眼看這段代碼可能覺得“該做的都做了”但真正跑起來就發(fā)現(xiàn)問題很多。最大的問題是阻塞等待ADC轉(zhuǎn)換STM32F103這類MCU的ADC單次轉(zhuǎn)換大約1微秒到幾微秒不等如果你每個PWM周期要采兩路一路等一次光這一項就吃掉好幾微秒。第二個問題是中斷里做低通濾波而且用的double在Cortex-M3/M4上double運算比float慢不少。第三是Park變換里的sinf和cosf雖然加了f后綴但庫函數(shù)還是在中斷里跑了幾百個周期。這些問題單看每一項好像都“還好”累積起來就比較致命。我們實測過這段代碼在一顆72MHz的Cortex-M3上跑一個20kHz中斷的執(zhí)行時間能到13.8微秒CPU占用率27.6%。電機不轉(zhuǎn)的時候沒問題一旦帶上負(fù)載電流波形毛刺明顯電機噪音也大。2.2 用IO翻轉(zhuǎn)和邏輯分析儀測性能基線不測量就沒有優(yōu)化。每寫一段優(yōu)化代碼之前我都會先在中斷入口和出口拉高拉低一個測試IO用邏輯分析儀看高電平時間寬度。這個方法土但非常有效能干到幾十納秒的精度。測法很簡單進(jìn)中斷先GPIO置高出中斷前GPIO置低邏輯分析儀采樣率設(shè)到100MHz以上抓幾個PWM周期高電平時間就是中斷執(zhí)行耗時。當(dāng)時測出的數(shù)據(jù)大致是項目數(shù)值PWM頻率20kHz周期50微秒中斷平均執(zhí)行時間13.8微秒中斷最大執(zhí)行時間15.2微秒CPU占用率27.6%ADC觸發(fā)方式軟件手動觸發(fā)阻塞等待采樣抖動峰峰值約±1.2微秒看到采樣抖動這行你可能就明白了為什么這個電機低速時會有周期性的噪聲。因為電流采樣點前后飄了1微秒以上在正弦波電流的過零點附近這個時間偏移對應(yīng)不小的電流誤差。這誤差進(jìn)了電流環(huán)等于給系統(tǒng)加了一個隨機擾動。2.3 明確瓶頸優(yōu)先級先時序后算法面對這段代碼我曾經(jīng)也想過先把sinf換掉、把double換float但實測發(fā)現(xiàn)這些還不是關(guān)鍵。核心瓶頸是先“什么時候采”的問題沒解決。軟件觸發(fā)ADC意味著你必須等ADC轉(zhuǎn)換完才能做下一步。你永遠(yuǎn)不知道前一次中斷里的其他代碼是不是拖沓了導(dǎo)致這次ADC觸發(fā)晚了。這個機制本質(zhì)上是串行依賴的天生就會引入抖動。所以第一優(yōu)先級是改采樣觸發(fā)方式把ADC觸發(fā)從“軟件觸發(fā)輪詢等待”改成“硬件定時觸發(fā)DMA搬運”。這樣ADC轉(zhuǎn)換和CPU計算可以在時間上重疊起來。等CPU真正拿到數(shù)據(jù)的時候ADC已經(jīng)把該轉(zhuǎn)的都轉(zhuǎn)完了。算法層面的優(yōu)化像濾波、坐標(biāo)變換可以放到后面做。先把時序理順往往能解決一大半問題。3. 優(yōu)化方案逐步落地從ADC觸發(fā)到DMA搬運3.1 用定時器硬件觸發(fā)ADC替代軟件觸發(fā)針對上面的痛點第一步就是把ADC改成由定時器主動觸發(fā)。STM32的高級定時器TIM1或TIM8在PWM輸出模式上有個很方便的特性可以配置為在中心對齊計數(shù)的上溢或下溢事件時輸出一個觸發(fā)信號給ADC。這樣ADC采樣就和PWM載波嚴(yán)格同步了不需要軟件干預(yù)。SVPWM的中心對齊模式下定時器計數(shù)值先增后減遞減到0的時刻下溢正好是三相下橋全部導(dǎo)通的窗口中心在這里觸發(fā)ADC采樣是最理想的。配置的核心代碼大致長這樣// 以STM32F407為例使用TIM1的TRGO觸發(fā)ADC1 TIM_SelectOutputTrigger(TIM1, TIM_TRGO_UPDATE); // 或者根據(jù)需求用TIM_TRGO_CC1IF等事件 ADC_InitTypeDef adc_init; // ADC獨立模式12位采樣時間盡量短但保證充足 adc_init.ADC_Mode ADC_Mode_Independent; adc_init.ADC_ExternalTrigConv ADC_ExternalTrigConv_T1_TRGO; adc_init.ADC_ExternalTrigConvEdge ADC_ExternalTrigConvEdge_Rising; adc_init.ADC_Resolution ADC_Resolution_12b; // 其他配置略配置好以后你每次PWM周期內(nèi)不需要再調(diào)用ADC1_StartConversion()ADC硬件會在定時器事件到來時自動啟動轉(zhuǎn)換。這里有個細(xì)節(jié)觸發(fā)邊沿要選對。如果你的定時器配置為上溢和下溢都會更新那就需要根據(jù)實際配置選擇沿。常用的做法是配置成僅在向下計數(shù)到0時觸發(fā)一次這樣每個PWM周期只采樣一次。如果你的電流環(huán)需要每個周期采集兩次比如在某些特殊工況下需要兩個矢量作用時刻的電流用于低調(diào)制比下的重構(gòu)再改成雙觸發(fā)。3.2 打開ADC的DMA模式讓數(shù)據(jù)自動搬運光靠硬件觸發(fā)還不夠因為轉(zhuǎn)換完成標(biāo)志還是要軟件去查。此時引入DMA就順理成章了。ADC每個通道轉(zhuǎn)換完成后DMA會自動把數(shù)據(jù)從ADC的數(shù)據(jù)寄存器搬到內(nèi)存數(shù)組里不需要CPU參與搬運。配置DMA的要點有兩個一是工作在循環(huán)模式這樣每個PWM周期DMA都會自動搬運一組新數(shù)據(jù)永遠(yuǎn)不用重裝二是數(shù)據(jù)長度要和ADC通道數(shù)對齊。DMA_InitTypeDef dma_init; dma_init.DMA_Channel DMA_Channel_0; // ADC1對應(yīng)DMA2 Stream0按芯片手冊選 dma_init.DMA_PeripheralBaseAddr (uint32_t)ADC1-DR; dma_init.DMA_Memory0BaseAddr (uint32_t)adc_buffer; dma_init.DMA_DIR DMA_DIR_PeripheralToMemory; dma_init.DMA_BufferSize 2; // 兩路電流采樣 dma_init.DMA_Mode DMA_Mode_Circular; // 循環(huán)模式 dma_init.DMA_PeripheralInc DMA_PeripheralInc_Disable; dma_init.DMA_MemoryInc DMA_MemoryInc_Enable; dma_init.DMA_PeripheralDataSize DMA_PeripheralDataSize_HalfWord; dma_init.DMA_MemoryDataSize DMA_MemoryDataSize_HalfWord; dma_init.DMA_Priority DMA_Priority_High; dma_init.DMA_FIFOMode DMA_FIFOMode_Disable;DMA模式下CPU完全不用等ADC。電流環(huán)中斷觸發(fā)時直接讀adc_buffer[0]和adc_buffer[1]即可。注意要用volatile修飾緩沖數(shù)組否則編譯器可能在優(yōu)化時把兩次讀數(shù)組重排或直接緩存到寄存器里讀到舊數(shù)據(jù)。內(nèi)核里有一個非常反直覺的坑——你讀DMA緩沖時DMA可能正好在搬運新數(shù)據(jù)。雖然循環(huán)模式下ADC的兩個通道是順序轉(zhuǎn)換的但如果你在PWM中斷里讀到的兩路數(shù)據(jù)分別屬于兩個不同的PWM周期那你用來算Clark變換的ia和ib就不是同一時刻的電流值會產(chǎn)生額外的相位誤差。解決辦法有兩個要么在PWM中斷里讀數(shù)據(jù)時先關(guān)DMA再讀再開DMA這種方法如果操作不當(dāng)會丟失一個觸發(fā)事件不一定好要么配置ADC為注入組單次掃描模式用注入組轉(zhuǎn)換結(jié)束事件觸發(fā)中斷保證兩個通道是同一批次轉(zhuǎn)換出來的。我個人更推薦后者因為它從機制上保證了兩個值的時間一致性。3.3 電流環(huán)中斷瘦身只留真正必要的計算硬件觸發(fā)和DMA解決的問題是“采集過程不占用CPU時間”。但中斷里仍然存在一些不合理的計算。先看濾波部分。有些工程師習(xí)慣把低通濾波放在中斷里但我們得想清楚FOC電流環(huán)本身就是一個帶寬很高的環(huán)路你砍掉高頻噪聲是可以的但如果濾波太深會把有用信號也削掉。比如你用0.1的系數(shù)做低通等效帶寬可能已經(jīng)低于電流環(huán)帶寬了這會導(dǎo)致相位延遲增大。更穩(wěn)妥的做法是如果ADC采樣毛刺不是特別嚴(yán)重直接用硬件層面優(yōu)化。比如把ADC采樣時間從1.5周期加到3個周期讓采樣電容充分充電毛刺往往就下來了。實在需要軟件濾波優(yōu)先用一階IIR系數(shù)選0.7到0.9之間別低于0.7。再來看坐標(biāo)變換時的sinf和cosf。我理解很多人圖省事直接用數(shù)學(xué)庫但它的實現(xiàn)里包含精度和兼容性考慮往往不是最快的。FOC里角度theta的變化是有規(guī)律可循的在很多項目里可以把sin/cos表做成512點甚至1024點的查找表查表加線性插值的誤差足夠小速度卻快很多。3.4 用查表替代實時三角函數(shù)計算舉一個具體例子。假設(shè)電機最高電頻率是500HzPWM頻率20kHz也就是每個電周期有40個PWM周期。如果用512點sin表每次查表之間角度步進(jìn)是360/512約等于0.7度對電流環(huán)來說精度已經(jīng)足夠好了。查表法實現(xiàn)如下#define SIN_TABLE_SIZE 512 #define SIN_TABLE_MASK (SIN_TABLE_SIZE - 1) // 建表時一次性算好 static float sin_table[SIN_TABLE_SIZE]; void sin_table_init(void) { for (int i 0; i SIN_TABLE_SIZE; i) { sin_table[i] sinf(2.0f * PI * i / SIN_TABLE_SIZE); } } // 查表線性插值 float fast_sin(float angle_rad) { float index_f angle_rad * (SIN_TABLE_SIZE / (2.0f * PI)); int32_t index (int32_t)index_f; float frac index_f - (float)index; index SIN_TABLE_MASK; int32_t index_next (index 1) SIN_TABLE_MASK; return sin_table[index] (sin_table[index_next] - sin_table[index]) * frac; }實際項目中這個查表函數(shù)在Cortex-M4上大概幾十個周期就能跑完比sinf快一半還多。3.5 電流環(huán)代碼抽離緊急任務(wù)和非緊急任務(wù)分開電流環(huán)中斷里除了坐標(biāo)變換和PID往往還混著一些不太相關(guān)的東西。比如有的工程師會把轉(zhuǎn)速估算、弱磁控制、過流保護(hù)邏輯全塞在一個中斷里。這類問題在優(yōu)化時要拆開。FOC中真正需要和PWM同頻執(zhí)行的部分只有電流采樣讀取、坐標(biāo)變換、電流環(huán)PID、SVPWM輸出。這些都是必須在載波周期內(nèi)完成的“緊急任務(wù)”。轉(zhuǎn)速估算這類東西很多時候不需要20kHz的頻率。如果你的目標(biāo)帶寬在100Hz左右那么轉(zhuǎn)速估算哪怕降到1kHz也沒有問題。把它挪到低優(yōu)先級定時中斷或者主循環(huán)里跑能大幅減輕高頻中斷的負(fù)擔(dān)。過流保護(hù)必須走硬件比較器或ADC模擬看門狗這是硬件級別的快速保護(hù)不能讓軟件延遲決定是否炸MOS管。軟件層面的過流檢測可以作為第二道防線不要把它和電流環(huán)PID混在同一個中斷里。3.6 把高頻中斷放到RAM里執(zhí)行這個優(yōu)化點知道的人不算多但在Flash速度慢的MCU上非常有效。很多MCU從Flash取指令是有等待周期的尤其是高頻時鐘下。比如STM32F4在168MHz主頻下Flash等待周期可能到5個周期這意味著每條指令都要多等好幾個周期。解決辦法是直接把電流環(huán)中斷服務(wù)函數(shù)放進(jìn)RAM執(zhí)行。GCC環(huán)境下用__attribute__((section(.ramfunc)))即可IAR則用__ramfunc關(guān)鍵字。__attribute__((section(.ramfunc))) void TIM1_UP_IRQHandler(void) { // 快速執(zhí)行電流環(huán) }注意這段函數(shù)會被拷貝到RAM里運行如果RAM緊張就不能放太多內(nèi)容。實際項目中我通常只把最關(guān)鍵的電流環(huán)ISR放進(jìn)去其他普通中斷保持原地不動。4. 優(yōu)化后的代碼長什么樣4.1 結(jié)構(gòu)清晰的電流環(huán)主流程經(jīng)過了上面幾步的優(yōu)化電流環(huán)中斷的代碼就清爽多了。下面是我在項目中實際使用過的簡化版本// 電流環(huán)中斷TIM1下溢硬件觸發(fā)ADCDMA搬運 __attribute__((section(.ramfunc))) void TIM1_UP_IRQHandler(void) { adc_dma_buffer_t adc read_adc_buffer(); // 原始電流還原 float ia adc.sample_a * K_SCALE - I_BIAS; float ib adc.sample_b * K_SCALE - I_BIAS; float ic -(ia ib); // 可選的弱濾波只在必要時啟用 ia iir_lpf(ia, filter_a_state); ib iir_lpf(ib, filter_b_state); // Clark變換 i_alpha ia; i_beta (ia 2.0f * ib) * SQRT1_3; // Park變換查表法 float s fast_sin(theta), c fast_cos(theta); id i_alpha * c i_beta * s; iq -i_alpha * s i_beta * c; // 電流環(huán)PID pid_id_run(pid_id, id, id_ref); pid_iq_run(pid_iq, iq, iq_ref); // 反Park變換 vd id_out * c - iq_out * s; vq id_out * s iq_out * c; // SVPWM輸出 svpwm_apply(vd, vq); }這段代碼的精髓在于數(shù)據(jù)已經(jīng)從DMA那準(zhǔn)備好了濾波函數(shù)做了輕量化三角函數(shù)用查表整個中斷里沒有阻塞等待沒有多余的判斷分支。你甚至可以把這段代碼的執(zhí)行時間控制得很穩(wěn)定這對FOC控制的一致性非常重要。4.2 ADC配置代碼的完整示例光看中斷代碼還不夠ADC和DMA的初始化也要配套。這里給一個相對完整的STM32F4系列初始化參考。void foc_adc_init(void) { ADC_InitTypeDef adc_init; DMA_InitTypeDef dma_init; GPIO_InitTypeDef gpio_init; NVIC_InitTypeDef nvic_init; // 使能ADC1時鐘和GPIO時鐘 RCC_APB2PeriphClockCmd(RCC_APB2Periph_ADC1, ENABLE); RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_DMA2 | RCC_AHB1Periph_GPIOC, ENABLE); // PC0和PC1作為模擬輸入對應(yīng)ADC1的通道10和通道11 gpio_init.GPIO_Pin GPIO_Pin_0 | GPIO_Pin_1; gpio_init.GPIO_Mode GPIO_Mode_AN; gpio_init.GPIO_PuPd GPIO_PuPd_NOPULL; GPIO_Init(GPIOC, gpio_init); // DMA2 Stream0配置 dma_init.DMA_Channel DMA_Channel_0; dma_init.DMA_PeripheralBaseAddr (uint32_t)ADC1-DR; dma_init.DMA_Memory0BaseAddr (uint32_t)foc_adc_dma_buffer; dma_init.DMA_DIR DMA_DIR_PeripheralToMemory; dma_init.DMA_BufferSize 2; dma_init.DMA_PeripheralInc DMA_PeripheralInc_Disable; dma_init.DMA_MemoryInc DMA_MemoryInc_Enable; dma_init.DMA_PeripheralDataSize DMA_PeripheralDataSize_HalfWord; dma_init.DMA_MemoryDataSize DMA_MemoryDataSize_HalfWord; dma_init.DMA_Priority DMA_Priority_High; dma_init.DMA_Mode DMA_Mode_Circular; DMA_Init(DMA2_Stream0, dma_init); // ADC1配置 adc_init.ADC_Mode ADC_Mode_Independent; adc_init.ADC_ScanConvMode ENABLE; // 掃描模式多通道 adc_init.ADC_ContinuousConvMode DISABLE; // 超時觸發(fā)不是連續(xù)轉(zhuǎn)換 adc_init.ADC_ExternalTrigConvEdge ADC_ExternalTrigConvEdge_Rising; adc_init.ADC_ExternalTrigConv ADC_ExternalTrigConv_T1_TRGO; // TIM1觸發(fā) adc_init.ADC_DataAlign ADC_DataAlign_Right; adc_init.ADC_NbrOfConversion 2; ADC_Init(ADC1, adc_init); // 配置兩個通道的采樣時間 ADC_RegularChannelConfig(ADC1, ADC_Channel_10, 1, ADC_SampleTime_3Cycles); ADC_RegularChannelConfig(ADC1, ADC_Channel_11, 2, ADC_SampleTime_3Cycles); // 使能DMA和ADC ADC_DMACmd(ADC1, ENABLE); ADC_Cmd(ADC1, ENABLE); }初始化代碼里需要注意的一個細(xì)節(jié)是掃描模式下ADC的通道順序就決定DMA緩沖里的數(shù)據(jù)順序。你必須清楚通道10對應(yīng)dma_buffer[0]通道11對應(yīng)dma_buffer[1]后面讀數(shù)據(jù)時別搞反。4.3 優(yōu)化后的性能參數(shù)實測代碼改完之后我用同樣的邏輯分析儀測了一輪結(jié)果對比如下指標(biāo)優(yōu)化前優(yōu)化后中斷平均執(zhí)行時間13.8微秒4.2微秒中斷最大執(zhí)行時間15.2微秒4.5微秒CPU占用率20kHz中斷27.6%8.4%采樣抖動峰峰值±1.2微秒±0.15微秒電流波形毛刺明顯帶載時噪聲大基本消除CPU占用從27.6%降到8.4%直接省出了19個百分點的算力。這個余量你可以用來做無傳感器觀測器、做在線參數(shù)辨識或者干脆降低主頻以省電。采樣抖動從1.2微秒壓到0.15微秒電機低速時的周期性噪聲基本消失。5. 高頻FOC工程中的常見問題清單5.1 采樣點正好落在死區(qū)或者窄脈寬區(qū)間電流采集要避開死區(qū)時間否則采樣出來的電流不是真實相電流。這個問題在做小占空比、低調(diào)制比工況時尤其容易踩。SVPWM載波中心的下橋?qū)ù翱谌绻瑼DC采樣時刻稍微偏一點就可能采到死區(qū)期間的回流狀態(tài)。解決思路是加入最小采樣窗口判斷。比如計算當(dāng)前PWM周期的有效下橋?qū)〞r間如果低于某個閾值比如3微秒就放棄本輪采樣用上一次的電流值或者把ADC觸發(fā)點往安全方向偏移。5.2 電流過采樣濾波后出現(xiàn)了額外相位延遲有些工程師為了讓波形更干凈喜歡把多個PWM周期內(nèi)的電流采樣值做平均。比如四周期滑動平均這在軟件上很好寫但效果不一定好。因為滑動平均本質(zhì)是一個FIR濾波器它本身會引入大約1.5個采樣周期的延遲。在電流環(huán)里這個延遲直接轉(zhuǎn)化為相位滯后。我見過有人把滑動窗口加到八個點結(jié)果電機跑高速時電流環(huán)開始振蕩。濾波不是越強越好做電流環(huán)濾波時一定要拿示波器看階躍響應(yīng)確認(rèn)沒有額外相移。5.3 DMA循環(huán)模式下讀到了“半新半舊”的數(shù)據(jù)這個問題我在3.2節(jié)提了一些實際項目中經(jīng)常讓人頭疼。DMA循環(huán)模式是永遠(yuǎn)在跑的你讀數(shù)組的時候數(shù)組里面可能既有前一周期數(shù)據(jù)又有本周期的數(shù)據(jù)。這在ADC掃描模式配置不當(dāng)?shù)臅r候尤其明顯。我的建議是果斷使用注入組轉(zhuǎn)換。注入組轉(zhuǎn)換可以配置為一次轉(zhuǎn)換一組通道并把結(jié)果鎖存到注入數(shù)據(jù)寄存器里。這樣讀到的兩個值才是嚴(yán)格同一時刻的快照不需要用開關(guān)DMA這種粗糙的規(guī)避方案。5.4 PFC和電機驅(qū)動共用MCU時中斷優(yōu)先級怎么定很多項目是一個MCU同時管PFC和電機FOC。PFC通常也是高頻控制兩個電流環(huán)中斷優(yōu)先級一旦配錯系統(tǒng)就會出現(xiàn)奇怪的震蕩。一個基本準(zhǔn)則是哪個環(huán)路帶寬高、故障風(fēng)險大哪個優(yōu)先級就高。FOC的過流風(fēng)險更大通常FOC電流環(huán)中斷優(yōu)先于PFC。PFC的電流環(huán)如果稍微滯后一拍一般不會炸機但FOC的電流環(huán)滯后就會導(dǎo)致電流失控。5.5 在中斷里不要用printf這條聽著像廢話但真的有人踩坑。FOC電流環(huán)20kHz頻率下你要是往中斷里塞一個printf哪怕是重定向到數(shù)組緩存也會大量占用CPU時間甚至把中斷棧頂爆掉。調(diào)試的時候可以用IO翻轉(zhuǎn)邏輯分析儀或者DMA串口輸出少量關(guān)鍵變量不要用阻塞式的printf。真要看波形把變量存到一個環(huán)形緩沖區(qū)然后讓上位機通過慢速通道慢慢讀這個通道放在主循環(huán)里執(zhí)行就行。6. 優(yōu)化思路的橫向遷移不只適用于FOC這套優(yōu)化方法并不是只能用在FOC電流采集上。數(shù)字電源的電壓電流雙環(huán)、伺服驅(qū)動的編碼器采樣、并網(wǎng)逆變器的電網(wǎng)電壓鎖相環(huán)它們本質(zhì)都是“高速外設(shè)采樣高頻控制中斷延遲敏感閉環(huán)”。你只要記住這條主線數(shù)據(jù)準(zhǔn)備盡量用硬件自動完成CPU在中斷里只做真正的控制運算最后用測量數(shù)據(jù)驗證每一個環(huán)節(jié)的開銷。哪里延遲大就把哪里往硬件卸載或者往低頻搬。我自己在數(shù)字電源項目里也復(fù)用了這套ADCDMA定時器觸發(fā)機制效果同樣明顯。所以這篇文章的內(nèi)容與其說是“FOC電流采集代碼優(yōu)化”不如說是一套嵌入式高實時性閉環(huán)的通用套路。最后說一個個人心得做這類優(yōu)化不要一上來就懷疑自己的控制算法不行。先把鏈路里每一段延遲都測出來、量出來讓數(shù)據(jù)告訴你瓶頸在哪里。大多數(shù)情況下問題根本不在PID參數(shù)而在數(shù)據(jù)通路本身。把通路理順了電流環(huán)自然就聽話了。