無(wú)感 FOC 跑高速不難難的是上電那一刻轉(zhuǎn)子停在哪個(gè)角度不清楚你甚至不知道第一相電流該往哪里推。很多 PMSM 電機(jī)無(wú)感矢量控制項(xiàng)目最終不是敗在觀測(cè)器上而是敗在“第一次給電就給了個(gè)錯(cuò)誤的方向”。做過(guò)無(wú)感永磁同步電機(jī)啟動(dòng)調(diào)試的工程師大概率都遇到過(guò)這類現(xiàn)象電機(jī)還沒(méi)有收到速度指令轉(zhuǎn)子先自己抖了一下或者啟動(dòng)瞬間反沖半圈嚴(yán)重的直接過(guò)流報(bào)警。如果是在帶載狀態(tài)下這種啟動(dòng)失敗會(huì)表現(xiàn)得更加明顯——帶不動(dòng)、反轉(zhuǎn)、抖動(dòng)、報(bào)故障現(xiàn)場(chǎng)問(wèn)題清單能列一長(zhǎng)串。這篇文章要聊的就是解決這個(gè)“第一把電該怎么給”的問(wèn)題PMSM 電機(jī) IPDInitial Position Detection初始位置辨識(shí)里的脈沖注入法。文章會(huì)從三個(gè)層面展開(kāi)第一為什么零低速下必須做初始位置辨識(shí)它解決了什么問(wèn)題第二脈沖注入法到底在測(cè)什么物理量不把原理吃透參數(shù)調(diào)到天亮也調(diào)不明白第三完整的實(shí)機(jī)測(cè)試流程、代碼骨架、判定標(biāo)準(zhǔn)和排錯(cuò)方法讓這套算法不止停留在論文里而是能落到你的調(diào)試臺(tái)架上。1. 為什么說(shuō)初始位置辨識(shí)是零低速啟動(dòng)的第一道坎先看一個(gè)很基礎(chǔ)的背景無(wú)感 FOC 里轉(zhuǎn)子位置信息是整個(gè)坐標(biāo)變換的前提。Park 變換需要知道當(dāng)前轉(zhuǎn)子電角度才能把定子電流分解成真正的 d 軸電流和 q 軸電流。電流環(huán)、速度環(huán)、SVPWM全部建立在這個(gè)角度上。反電動(dòng)勢(shì)觀測(cè)器、滑模觀測(cè)器、模型參考自適應(yīng)這一類方法本質(zhì)上都在利用一個(gè)共同信號(hào)反電動(dòng)勢(shì)。但反電動(dòng)勢(shì)的大小和轉(zhuǎn)速成正比轉(zhuǎn)子不動(dòng)時(shí)反電動(dòng)勢(shì)為零低速時(shí)反電動(dòng)勢(shì)幅值很小在零速到低速這一段單純靠反電動(dòng)勢(shì)類觀測(cè)器很難給出可信角度。這和 FOC 的啟動(dòng)需求形成了矛盾?？刂破魃想姾笏俣拳h(huán)輸出不一定為零負(fù)載可能已經(jīng)在轉(zhuǎn)子上掛著。如果你告訴電流環(huán)“角度是 0°”而轉(zhuǎn)子真實(shí)位置在 150° 電角度那么你給出來(lái)的 q 軸電流指令實(shí)際作用在轉(zhuǎn)子上的力矩方向就是錯(cuò)的。結(jié)果可能是反轉(zhuǎn)可能是堵轉(zhuǎn)也可能是母線電壓直接被打到過(guò)流保護(hù)閾值。這里想強(qiáng)調(diào)一個(gè)容易被忽視的判斷PMSM 電機(jī)的無(wú)感帶載啟動(dòng)能力瓶頸不在高速觀測(cè)器而在啟動(dòng)瞬間的位置殘差。初始角度誤差一旦超過(guò)一定范圍后面所有“看起來(lái)不錯(cuò)”的算法都會(huì)表現(xiàn)為啟動(dòng)失敗。很多人會(huì)問(wèn)既然零速反電動(dòng)勢(shì)為零那干脆給一個(gè)固定電流把轉(zhuǎn)子強(qiáng)拖到已知位置不就行了這就是早期的“預(yù)定位”思路。它簡(jiǎn)單但有兩個(gè)明顯問(wèn)題必須保證轉(zhuǎn)子能自由轉(zhuǎn)動(dòng)定位過(guò)程會(huì)先產(chǎn)生一個(gè)不確定方向的力矩帶載時(shí)可能拖不動(dòng)還可能在定位結(jié)束前就過(guò)流。如果電機(jī)通過(guò)減速機(jī)構(gòu)連接負(fù)載或者負(fù)載本身存在摩擦、齒槽力矩預(yù)定位能不能真的把轉(zhuǎn)子拉到目標(biāo)角度本身就要打問(wèn)號(hào)。這就是初始位置辨識(shí)技術(shù)存在的意義不是讓轉(zhuǎn)子被動(dòng)地被拖到已知位置而是主動(dòng)檢測(cè)出轉(zhuǎn)子的真實(shí)初始位置。2. IPD 概念澄清電機(jī)控制里的 IPD 和研發(fā)流程里的 IPD 不是一回事搜索“IPD”這個(gè)詞的時(shí)候你會(huì)翻到大量和“華為 IPD”“IPD 六個(gè)階段評(píng)審”“IPD charter 范例”相關(guān)的內(nèi)容。那個(gè) IPD 是 Integrated Product Development集成產(chǎn)品開(kāi)發(fā)屬于研發(fā)管理體系而電機(jī)控制領(lǐng)域說(shuō)的 IPD是 Initial Position Detection初始位置檢測(cè)。兩者只是英文縮寫(xiě)恰好重合。所以如果你帶著電機(jī)控制的問(wèn)題去搜索“IPD 怎么用”“IPD 初始位置辨識(shí)”很可能先看到一堆產(chǎn)品開(kāi)發(fā)流程文檔。建議在技術(shù)搜索時(shí)帶上限定詞比如“PMSM IPD motor”“IPD initial position”“脈沖注入初始位置辨識(shí)”這樣才會(huì)進(jìn)入正確的技術(shù)上下文。在 PMSM 電機(jī)控制系統(tǒng)里IPD 指的是這樣一段功能速度為零且沒(méi)有位置傳感器時(shí)通過(guò)給電機(jī)施加特定電壓信號(hào)根據(jù)電流響應(yīng)推算轉(zhuǎn)子初始 d 軸電角度并判斷磁極極性。它通常發(fā)生在電機(jī)啟動(dòng)之前是一個(gè)“一次性的檢測(cè)過(guò)程”而不是實(shí)時(shí)在線跟蹤。3. 初始位置辨識(shí)的主流實(shí)現(xiàn)路線先做一個(gè)整體對(duì)比看看脈沖注入法在技術(shù)路線里處于什么位置。方法基本思路適用時(shí)機(jī)優(yōu)點(diǎn)局限預(yù)定位給固定電流將轉(zhuǎn)子強(qiáng)拉到已知角度啟動(dòng)前實(shí)現(xiàn)簡(jiǎn)單要求轉(zhuǎn)子可自由轉(zhuǎn)動(dòng)帶載定位不可靠旋轉(zhuǎn)高頻電壓注入注入高頻旋轉(zhuǎn)電壓提取負(fù)序電流中的位置信息零低速持續(xù)跟蹤可在線跟蹤實(shí)現(xiàn)復(fù)雜會(huì)產(chǎn)生轉(zhuǎn)矩脈動(dòng)和噪聲脈振高頻電壓注入在估計(jì) d 軸注入高頻電壓解調(diào)位置誤差零低速持續(xù)跟蹤信噪比相對(duì)高需要建立高頻模型濾波多脈沖電壓矢量法向多個(gè)固定方向施加短時(shí)電壓脈沖比較電流響應(yīng)啟動(dòng)前一次性定位時(shí)間短、可帶載啟動(dòng)需要磁凸極特性不適合所有電機(jī)預(yù)定位加反電動(dòng)勢(shì)復(fù)合先粗定位再通過(guò)拖動(dòng)切換閉環(huán)全速度范圍工程簡(jiǎn)單啟動(dòng)動(dòng)態(tài)受限依賴預(yù)定位精度本文討論的是“脈沖電壓矢量法”它在軟件實(shí)現(xiàn)上通常是一個(gè)幾十毫秒以內(nèi)的狀態(tài)機(jī)依次輸出不同方向的電壓矢量采集電流響應(yīng)計(jì)算出轉(zhuǎn)子 d 軸電角度再通過(guò)正反脈沖判斷磁極極性。整個(gè)過(guò)程發(fā)生在電機(jī)真正進(jìn)入速度環(huán)之前所以對(duì)持續(xù)運(yùn)行時(shí)的噪聲沒(méi)有影響。這個(gè)方法的工程價(jià)值在哪里最直接的價(jià)值是“能帶負(fù)載啟動(dòng)”。比如空調(diào)壓縮機(jī)停機(jī)后轉(zhuǎn)子停在一個(gè)隨機(jī)位置而且系統(tǒng)里可能存在冷媒壓力造成的負(fù)載力矩。預(yù)定位不一定能拖過(guò)去脈沖注入法卻可以在電機(jī)沒(méi)有明顯轉(zhuǎn)動(dòng)的情況下把初始角度測(cè)出來(lái)然后用正確的角度直接進(jìn)入啟動(dòng)流程。4. 脈沖注入法的物理基礎(chǔ)測(cè)量的是磁路的“不均勻”很多人第一次接觸脈沖注入法時(shí)會(huì)以為它是在窮舉角度把每個(gè)角度試一遍看哪個(gè)能轉(zhuǎn)起來(lái)。真實(shí)原理不是這樣。脈沖注入法真正測(cè)量的是磁路的各向異性。PMSM 轉(zhuǎn)子上有永磁體。對(duì)于內(nèi)置式永磁同步電機(jī)IPMSMd 軸磁路中永磁體的等效導(dǎo)磁率很低再加上磁橋結(jié)構(gòu)設(shè)計(jì)使得 d 軸電感和 q 軸電感并不相等通常表現(xiàn)為L(zhǎng)d Lq電感值隨電流變化存在明顯的磁飽和效應(yīng)當(dāng)我們?cè)诙ㄗ觽?cè)某個(gè)方向施加一個(gè)電壓脈沖時(shí)這個(gè)方向的電流上升速度和該方向?qū)?yīng)的等效電感大小直接相關(guān)。如果電壓方向恰好接近 d 軸由于 d 軸電感較小電流響應(yīng)會(huì)更“快”、更“強(qiáng)”如果電壓方向接近 q 軸電感較大電流響應(yīng)的幅值會(huì)相對(duì)小一些。換句話說(shuō)向不同方向注入相同幅值的電壓脈沖再測(cè)量電流響應(yīng)的幅值就能得到一條隨方向變化的“電感響應(yīng)曲線”。這條曲線的極值對(duì)應(yīng)了轉(zhuǎn)子 d 軸的方向。這就是脈沖注入法最核心的思想不靠反電動(dòng)勢(shì)靠磁路飽和造成的電感差異來(lái)定位。于是就有了一個(gè)重要判斷脈沖注入法能不能用好很大程度上取決于電機(jī)本體的凸極率和飽和特性。對(duì)于凸極率明顯的內(nèi)置式 PMSM脈沖注入法的信噪比通常比較好對(duì)于表貼式 PMSMLd 約等于 Lq固定方向電壓脈沖的電流響應(yīng)差異會(huì)很小這時(shí)候單純靠電流幅值比較來(lái)找 d 軸很容易失敗。磁極極性的判斷則依賴另一個(gè)現(xiàn)象磁飽和。如果我們?cè)谝呀?jīng)檢測(cè)出的 d 軸方向上施加一個(gè)正向電壓脈沖電流產(chǎn)生的磁動(dòng)勢(shì)和永磁體磁鏈方向相同會(huì)讓 d 軸磁路更飽和等效電感進(jìn)一步減小電流響應(yīng)增強(qiáng)如果施加反向脈沖磁動(dòng)勢(shì)先抵消一部分永磁磁場(chǎng)磁路沒(méi)那么飽和電感相對(duì)更大電流響應(yīng)減弱。比較同一個(gè) d 軸方向上的“正脈沖”和“反脈沖”的電流響應(yīng)響應(yīng)更大、電感更小的那個(gè)方向才是轉(zhuǎn)子磁極的 N 極電角度方向。簡(jiǎn)單說(shuō)先粗找 d 軸再判斷 0° 還是 180°這就是一個(gè)完整 IPD 閉環(huán)。5. 脈沖注入法實(shí)現(xiàn)流程拆解把算法落地到 MCU 上之前先梳理完整流程。5.1 輸入條件準(zhǔn)備脈沖注入法要求電機(jī)處于靜止或接近靜止?fàn)顟B(tài)。如果轉(zhuǎn)子在測(cè)試瞬間還在被外力拖動(dòng)反電動(dòng)勢(shì)會(huì)疊加到電壓方程里干擾電流響應(yīng)測(cè)出的角度就不可信。所以工程實(shí)現(xiàn)上第一步是判斷“電機(jī)是否真的停了”?？梢岳媚妇€電流為零、或者上一段運(yùn)行結(jié)束后的速度估算值來(lái)判斷。判斷結(jié)果不滿足時(shí)IPD 狀態(tài)機(jī)不應(yīng)該執(zhí)行。5.2 電壓矢量掃描接下來(lái)軟件會(huì)從第一個(gè)固定方向開(kāi)始依次注入電壓脈沖。常見(jiàn)做法是均勻分布 6 個(gè)方向也就是 0°、60°、120°、180°、240°、300° 的電角度網(wǎng)格。如果想要更高的粗定位分辨率可以增加到 12 路或 24 路。每個(gè)方向的注入過(guò)程分為三個(gè)小步輸出目標(biāo)電壓矢量等待脈沖寬度到達(dá)在電流建立到接近峰值時(shí)同步采樣電流得到該方向?qū)?yīng)的響應(yīng)幅值。要注意脈沖寬度不能太長(zhǎng)。如果電流持續(xù)建立時(shí)間過(guò)長(zhǎng)轉(zhuǎn)子會(huì)受到力矩作用開(kāi)始運(yùn)動(dòng)測(cè)出來(lái)的就不是靜止電感響應(yīng)而是一個(gè)帶運(yùn)動(dòng)學(xué)影響的復(fù)雜結(jié)果。脈沖寬度應(yīng)該控制在“能讓電流建立到足以測(cè)量但又不至于讓轉(zhuǎn)子明顯轉(zhuǎn)起來(lái)”的范圍。5.3 響應(yīng)處理與角度粗選各方向注入完成后軟件需要對(duì)響應(yīng)數(shù)組做比較。構(gòu)造邏輯大概是尋找響應(yīng)幅值最大的方向作為候選 d 軸如果 6 個(gè)方向之間的差異太小說(shuō)明凸極率不夠明顯要警惕算法可行性為了得到更細(xì)的角度可以對(duì)相鄰方向的響應(yīng)做二次曲線插值把極值點(diǎn)估計(jì)到若干個(gè)電角度以內(nèi)。這里真正容易踩坑的是響應(yīng)幅值的計(jì)算不能直接用單個(gè) ADC 原始值。最好使用同步采樣的兩相電流合成出電流矢量幅值或者至少使用同一時(shí)刻、同一個(gè)采樣窗口內(nèi)的多組值做平均避免 PWM 斬波噪聲造成虛假極值。5.4 磁極極性判斷粗選得到的角度只會(huì)告訴你“轉(zhuǎn)子 d 軸在這個(gè)方向或其反向 180°”它不能區(qū)分 N 極和 S 極。要區(qū)分需要在估計(jì) d 軸方向上施加正反向兩組脈沖在估計(jì)角 θ_est 注入正脈沖記錄響應(yīng) I_pos在 θ_est 180° 注入反脈沖記錄響應(yīng) I_neg如果 I_pos 大于 I_neg說(shuō)明 θ_est 方向是增磁方向真實(shí) d 軸就在 θ_est如果 I_neg 大于 I_pos則真實(shí) d 軸應(yīng)該補(bǔ)償 180°。需要補(bǔ)充一句對(duì)于某些飽和特性不明顯的電機(jī)極性判斷可能不夠穩(wěn)定。如果同樣的測(cè)試重復(fù)多次結(jié)果總在 0° 和 180° 之間跳變那多半不是算法寫(xiě)錯(cuò)了而是電機(jī)在當(dāng)前注入電壓水平下沒(méi)有表現(xiàn)出足夠明顯的飽和差異。5.5 切換進(jìn)入啟動(dòng)流程IPD 完成后控制器已經(jīng)拿到一個(gè)電角度。下一步通常不能直接把這個(gè)角度丟給速度環(huán)開(kāi)大扭矩。因?yàn)榇藭r(shí)轉(zhuǎn)速估算值還不穩(wěn)定更穩(wěn)妥的方式是進(jìn)入“開(kāi)環(huán)斜坡拖動(dòng)段”從初始角度開(kāi)始讓電壓矢量角度以低加速度遞增牽引電機(jī)正向旋轉(zhuǎn)同時(shí)等待反電動(dòng)勢(shì)觀測(cè)器收斂速度達(dá)到設(shè)定門檻后再平滑切換到 FOC 閉環(huán)。6. 環(huán)境準(zhǔn)備與關(guān)鍵參數(shù)設(shè)計(jì)6.1 硬件平臺(tái)建議做脈沖注入法實(shí)機(jī)測(cè)試推薦先在有位置傳感器的臺(tái)架上做不推薦直接在產(chǎn)品板上盲調(diào)。建議平臺(tái)配置一臺(tái)內(nèi)置式 PMSM也就是 IPMSM三相逆變器與直流母線電源MCU 支持 PWM 中心對(duì)齊、ADC 觸發(fā)采樣同步至少兩相電流采樣一個(gè)編碼器或者旋變作為角度基準(zhǔn)示波器和電流探頭用于觀察注入期間的電流波形。先有真實(shí)角度基準(zhǔn)你才能知道 IPD 算法的估計(jì)誤差是多少。直接在無(wú)感狀態(tài)下盲調(diào)失敗時(shí)很難判斷是算法問(wèn)題還是電機(jī)模型問(wèn)題。6.2 關(guān)鍵參數(shù)表下面表格總結(jié)了 IPD 調(diào)試中最關(guān)鍵的參數(shù)以及調(diào)節(jié)方向?qū)嶋H數(shù)值必須結(jié)合你的電機(jī)、母線電壓和控制器開(kāi)關(guān)頻率來(lái)確定。參數(shù)含義調(diào)節(jié)方向注意點(diǎn)注入電壓幅值每個(gè)方向電壓矢量占母線電壓的比例從 5% 開(kāi)始逐步增加電壓太低響應(yīng)弱太高過(guò)流或噪聲大脈沖寬度每個(gè)方向電壓保持時(shí)間從開(kāi)關(guān)周期的幾倍開(kāi)始試太短采不到太長(zhǎng)轉(zhuǎn)子會(huì)動(dòng)衰減等待時(shí)間每次注入后等待電流回零的時(shí)間一般為脈沖寬度的數(shù)倍以上太短會(huì)導(dǎo)致下次注入初值非零ADC 采樣窗口電流采樣時(shí)刻與 PWM 中心的關(guān)系放在開(kāi)關(guān)管開(kāi)通后的穩(wěn)定區(qū)避開(kāi)死區(qū)和振蕩注入方向數(shù)粗定位掃描的電壓矢量數(shù)量6 路起步不夠再加 12 路方向越多耗時(shí)越長(zhǎng)重復(fù)次數(shù)每個(gè)方向是否多次測(cè)量取均值根據(jù)噪聲水平調(diào)整連續(xù)注入要注意電機(jī)發(fā)熱7. 核心代碼骨架與實(shí)現(xiàn)說(shuō)明下面代碼體現(xiàn)的是算法結(jié)構(gòu)不綁定具體 MCU 廠商庫(kù)。硬件層的電壓矢量輸出和 ADC 采樣函數(shù)請(qǐng)?zhí)鎿Q成你實(shí)際工程中的驅(qū)動(dòng)接口。7.1 IPD 配置與狀態(tài)定義// 文件名pmsm_ipd.h #ifndef PMSM_IPD_H #define PMSM_IPD_H #include stdint.h #define IPD_SCAN_SECTORS 6u #define IPD_SCAN_DEG 60.0f #define IPD_ELEC_360 360.0f typedef struct { float udc; // 母線電壓?jiǎn)挝?V float vinj_pu; // 注入電壓標(biāo)幺值0.08 表示 8% 母線電壓 uint16_t t_pulse_us; // 單方向脈沖寬度 uint16_t t_wait_us; // 單方向注入后的電流衰減等待時(shí)間 uint8_t scan_num; // 粗定位方向數(shù) } Ipdt_Cfg_t; typedef struct { Ipdt_Cfg_t cfg; float est_angle_deg; // 辨識(shí)結(jié)果轉(zhuǎn)子 d 軸電角度 float response[IPD_SCAN_SECTORS]; // 每個(gè)方向的電流響應(yīng) uint8_t scan_done; uint8_t polarity_done; } Ipdt_Handle_t; void ipdt_init(Ipdt_Handle_t *ipd); uint8_t ipdt_run(Ipdt_Handle_t *ipd); #endif這組結(jié)構(gòu)體的目的是把 IPD 配置和運(yùn)行狀態(tài)集中管理。實(shí)際項(xiàng)目中建議把辨識(shí)結(jié)果放進(jìn)一個(gè)“電機(jī)控制共享結(jié)構(gòu)體”里方便啟動(dòng)狀態(tài)機(jī)讀取。7.2 單方向脈沖注入與電流響應(yīng)采樣// 文件名pmsm_ipd.c #include pmsm_ipd.h // 底層接口需要由工程提供 extern void pwm_set_voltage_angle(float theta_deg, float v_pu); extern void pwm_disable_output(void); extern float adc_get_current_magnitude(void); extern void delay_us_motor(uint32_t us); static float ipdt_inject_once(Ipdt_Handle_t *ipd, float theta_deg) { float current_resp 0.0f; // 1. 輸出目標(biāo)方向的電壓矢量 pwm_set_voltage_angle(theta_deg, ipd-cfg.vinj_pu); // 2. 等待電流建立到可測(cè)量范圍 delay_us_motor(ipd-cfg.t_pulse_us); // 3. 在脈沖保持階段采樣電流幅值 current_resp adc_get_current_magnitude(); // 4. 立即關(guān)斷輸出防止轉(zhuǎn)子被持續(xù)拉動(dòng) pwm_disable_output(); // 5. 等待電流衰減到零為下一次注入做準(zhǔn)備 delay_us_motor(ipd-cfg.t_wait_us); return current_resp; }需要說(shuō)明一下真正的工程實(shí)現(xiàn)不應(yīng)該使用阻塞式延時(shí)來(lái)等待脈沖結(jié)束更推薦把整個(gè)過(guò)程放在一個(gè)由 PWM 中斷驅(qū)動(dòng)的狀態(tài)機(jī)里讓注入、采樣、衰減三個(gè)狀態(tài)按節(jié)拍切換。這里用延時(shí)表達(dá)時(shí)序是為了讓算法邏輯更直觀。adc_get_current_magnitude這個(gè)函數(shù)在真實(shí)代碼里應(yīng)該返回兩相電流的合成幅值而不是某一相的原始讀數(shù)。因?yàn)殡妷菏噶糠较蚩赡茉谌我饨嵌葐蜗嚯娏鞣禃?huì)隨方向變化產(chǎn)生幾何誤差。7.3 六方向掃描與角度粗選static uint8_t ipdt_scan_sectors(Ipdt_Handle_t *ipd) { float max_resp 0.0f; uint8_t best_idx 0; for (uint8_t i 0; i IPD_SCAN_SECTORS; i) { float theta_cmd (float)i * IPD_SCAN_DEG; float resp ipdt_inject_once(ipd, theta_cmd); ipd-response[i] resp; if (resp max_resp) { max_resp resp; best_idx i; } } ipd-est_angle_deg (float)best_idx * IPD_SCAN_DEG; ipd-scan_done 1u; return 1u; }6 路掃描的精度是 60° 電角度一個(gè)格子。也就是說(shuō)完成這一步后你只能確定 d 軸落在以best_idx為中心的某個(gè)扇區(qū)里還不能直接用作最終角度。如果電機(jī)凸極率較好、噪聲較小可以通過(guò)比較相鄰兩個(gè)方向的響應(yīng)做一次插值把角度細(xì)化到幾度電角度的級(jí)別。一個(gè)典型的插值思路是對(duì)極值點(diǎn)左右兩個(gè)方向的響應(yīng)擬合二次曲線以二次曲線的頂點(diǎn)作為粗選角。這里不給出固定公式因?yàn)榍€形狀和電機(jī)飽和特性有關(guān)建議在實(shí)際數(shù)據(jù)上先擬合一次再?zèng)Q定用線性插值還是二次擬合。7.4 磁極極性判斷與 180° 補(bǔ)償static void ipdt_polarity_check(Ipdt_Handle_t *ipd) { float theta_est ipd-est_angle_deg; float i_pos ipdt_inject_once(ipd, theta_est); float i_neg ipdt_inject_once(ipd, theta_est 180.0f); // 正向脈沖電流響應(yīng)更大說(shuō)明該方向是增磁方向即 d 軸方向 if (i_neg i_pos) { if (ipd-est_angle_deg 180.0f) { ipd-est_angle_deg - 180.0f; } else { ipd-est_angle_deg 180.0f; } } ipd-polarity_done 1u; } uint8_t ipdt_run(Ipdt_Handle_t *ipd) { if (ipd-scan_done 0u) { ipdt_scan_sectors(ipd); } if (ipd-scan_done ! 0u ipd-polarity_done 0u) { ipdt_polarity_check(ipd); } return ipd-polarity_done; }極性判斷完成后est_angle_deg就代表了轉(zhuǎn)子 d 軸電角度。這個(gè)角度可以直接給 FOC 坐標(biāo)變換使用也可以作為啟動(dòng)斜坡電壓矢量的初始角度。8. 實(shí)機(jī)測(cè)試方法與結(jié)果判定代碼寫(xiě)完不是結(jié)束真正有價(jià)值的工作來(lái)自臺(tái)架驗(yàn)證。下面是一套可以復(fù)制到調(diào)試記錄里的測(cè)試流程。8.1 測(cè)試準(zhǔn)備先給電機(jī)接通編碼器或旋變的絕對(duì)位置讀數(shù)作為“基準(zhǔn)角度”。注意旋變和編碼器需要在控制器的坐標(biāo)系里做過(guò)零位對(duì)齊否則后面所有誤差對(duì)比都是錯(cuò)的。然后執(zhí)行下面幾步用有感 FOC 把電機(jī)運(yùn)行到某個(gè)位置并停機(jī)鎖住記錄編碼器反饋的角度作為基準(zhǔn)復(fù)位 IPD 狀態(tài)機(jī)執(zhí)行一次脈沖注入檢測(cè)記錄 IPD 輸出的估計(jì)電角度計(jì)算估計(jì)角度和基準(zhǔn)角度的殘差改變轉(zhuǎn)子位置重復(fù)測(cè)試。如果要測(cè)試帶載啟動(dòng)需要在機(jī)械軸上安裝負(fù)載或堵轉(zhuǎn)裝置然后從完全無(wú)感狀態(tài)執(zhí)行一次“IPD 斜坡啟動(dòng) 閉環(huán)”的完整流程觀察啟動(dòng)過(guò)程。8.2 測(cè)試記錄表每臺(tái)電機(jī)至少保存一份這樣的表格序號(hào)基準(zhǔn)角度IPD 估計(jì)角度角度殘差注入電壓脈沖寬度啟動(dòng)是否成功備注1待填寫(xiě)待填寫(xiě)待填寫(xiě)待填寫(xiě)待填寫(xiě)是/否測(cè)試條件2待填寫(xiě)待填寫(xiě)待填寫(xiě)待填寫(xiě)待填寫(xiě)是/否測(cè)試條件不要只測(cè)一個(gè)角度。轉(zhuǎn)子停在 0° 附近正常不代表停在 137° 也正常。建議覆蓋整個(gè)電角度周期至少均勻測(cè)試 12 個(gè)位置再統(tǒng)計(jì)最大殘差和重復(fù)性。8.3 通過(guò)標(biāo)準(zhǔn)建議判斷 IPD 算法能不能用于產(chǎn)品建議至少看四項(xiàng)角度重復(fù)性好。同一位置多次測(cè)量估計(jì)角度的散差要小不能來(lái)回跳變。極性判斷穩(wěn)定。連續(xù)測(cè)試多次不能偶爾出現(xiàn) 180° 顛倒。帶載啟動(dòng)無(wú)反轉(zhuǎn)。啟動(dòng)瞬間不能出現(xiàn)明顯反沖電流不能