操：開環(huán)轉(zhuǎn)動(dòng)、編碼器校準(zhǔn)到三環(huán)閉環(huán)調(diào)試)
先給結(jié)論如果你正在研究 FOC但又被 Clark 變換、Park 變換、SVPWM、PID 整定這些概念勸退那這篇文章就是給你寫的。正確的入門路徑不是一上來就啃算法推導(dǎo)而是先用最簡(jiǎn)單的開環(huán)控制讓電機(jī)轉(zhuǎn)起來確認(rèn)硬件、驅(qū)動(dòng)板、電源、編碼器全部正常然后再一步步往閉環(huán)算法里加?xùn)|西。電機(jī)能轉(zhuǎn)你就已經(jīng)走完了 FOC 入門最難的一大半。這次我們直接進(jìn)入實(shí)操層面。文章會(huì)先梳理 FOC 入門需要準(zhǔn)備哪些硬件和軟件然后帶你完成一次開環(huán)轉(zhuǎn)動(dòng)測(cè)試再做編碼器零點(diǎn)校準(zhǔn)最后把 FOC 的核心算法框架拆開講明白。整個(gè)過程不追求一次到位目標(biāo)是讓你有一個(gè)能跑、能調(diào)、能觀察波形的 FOC 調(diào)試環(huán)境。讀完你可以拿著這塊板子繼續(xù)做電流環(huán)、速度環(huán)、位置環(huán)的實(shí)驗(yàn)而不是停留在“看過原理”的階段。1. 核心能力速覽先給一張速覽表把 FOC 入門階段最關(guān)心的幾個(gè)問題一次性說清楚。能力項(xiàng)說明控制對(duì)象永磁同步電機(jī)PMSM、無刷直流電機(jī)BLDC帶編碼器反饋開環(huán)控制支持適合硬件自檢、電機(jī)確認(rèn)、初始轉(zhuǎn)動(dòng)測(cè)試閉環(huán)算法電流環(huán)、速度環(huán)、位置環(huán)從單環(huán)到三環(huán)逐級(jí)增加電流采樣一般使用雙電阻或三電阻下橋采樣部分方案也用單電阻推薦硬件常見 STM32 開發(fā)板、SimpleFOC 驅(qū)動(dòng)板、一體化驅(qū)動(dòng)板均適用軟件環(huán)境Arduino IDE、SimpleFOC 庫(kù)、STM32CubeMX 等按你的 MCU 方案選擇顯存需求無純嵌入式項(xiàng)目不涉及 GPU 或本地模型推理啟動(dòng)方式編譯燒錄啟動(dòng)上位機(jī)一般通過串口連接接口能力串口指令控制可通過串口修改 PID 參數(shù)、讀取角度速度和電流數(shù)據(jù)批量任務(wù)不適用FOC 是實(shí)時(shí)控制任務(wù)不是離線批量任務(wù)場(chǎng)景適學(xué)人群嵌入式開發(fā)者、機(jī)器人愛好者、無人機(jī)/云臺(tái)調(diào)參工程師、學(xué)生從這張表能看出FOC 入門階段的重點(diǎn)不在“裝環(huán)境”而在“把硬件和代碼配合起來”。軟硬件鏈路一旦跑通后面做閉環(huán)就是調(diào)參工作。2. 適用場(chǎng)景與使用邊界2.1 適合哪些場(chǎng)景FOC 適用的場(chǎng)景很廣常見的包括云臺(tái)電機(jī)控制要求力矩平穩(wěn)、響應(yīng)快、位置精確。小型機(jī)器人關(guān)節(jié)需要位置環(huán)和速度環(huán)配合。無人機(jī)無刷電機(jī)驅(qū)動(dòng)追求效率和高動(dòng)態(tài)響應(yīng)。工業(yè)伺服入門學(xué)習(xí)理解電流環(huán)-速度環(huán)-位置環(huán)的嵌套關(guān)系。無感 FOC 研究先通過有感 FOC 驗(yàn)證算法再去掉編碼器做無感觀測(cè)器。如果你是初學(xué)者最合適的場(chǎng)景就是“桌面級(jí)硬件 開環(huán)轉(zhuǎn)動(dòng) 編碼器校準(zhǔn) 單電流環(huán)調(diào)試”。這套流程成本低風(fēng)險(xiǎn)小而且能覆蓋 FOC 最核心的知識(shí)點(diǎn)。2.2 不適合哪些場(chǎng)景純軟件學(xué)習(xí)、不打算碰硬件的同學(xué)。FOC 還是要實(shí)際操作才能理解沒有真實(shí)電機(jī)反饋很多概念很難建立直覺。需要超高功率驅(qū)動(dòng)的工業(yè)場(chǎng)景。入門級(jí)驅(qū)動(dòng)板和低壓電機(jī)不適合直接放大功率否則容易燒板子。想“零基礎(chǔ)一次看懂全部 FOC 公式推導(dǎo)”的同學(xué)。FOC 涉及較多坐標(biāo)變換和 PI 調(diào)節(jié)理論建議先操作后理論或者邊操作邊看公式。2.3 合規(guī)與安全邊界FOC 調(diào)試涉及電機(jī)轉(zhuǎn)動(dòng)和電流采樣有三點(diǎn)必須注意實(shí)驗(yàn)環(huán)境要固定好電機(jī)防止電機(jī)高速旋轉(zhuǎn)時(shí)飛出傷人。電源要選擇合適的限流不要超過驅(qū)動(dòng)板和電機(jī)的額定值。調(diào)試閉環(huán)時(shí)先給較小的電流和速度限制不要一開始就跑滿占空比。另外如果后續(xù)把 FOC 用于實(shí)際產(chǎn)品一定要確認(rèn)電機(jī)的使用許可、驅(qū)動(dòng)方案的可靠性以及相關(guān)安全認(rèn)證。FOC 本身是完全開放的控制技術(shù)不涉及版權(quán)問題但不同硬件方案的固件和驅(qū)動(dòng)代碼需要遵守對(duì)應(yīng)開源協(xié)議。3. 環(huán)境準(zhǔn)備與前置條件3.1 硬件清單做 FOC 入門不需要特別昂貴的設(shè)備。一套典型的實(shí)驗(yàn)環(huán)境如下硬件說明帶編碼器的無刷電機(jī)常見的有感無刷電機(jī)如云臺(tái)電機(jī)、FOC 專用教學(xué)電機(jī)編碼器建議選用磁編碼器或 ABZ 增量編碼器FOC 驅(qū)動(dòng)板常見方案為 SimpleFOC Shield、基于 DRV8301/DRV8302 的驅(qū)動(dòng)板、或帶電流采樣的集成驅(qū)動(dòng)板主控板STM32F103/F405、Arduino UNO、Arduino Due、ESP32 等選型取決于驅(qū)動(dòng)板和算法復(fù)雜度直流電源一般 12V 或 24V 低壓電源注意電流能力要滿足電機(jī)峰值串口調(diào)試工具USB-TTL 串口模塊用于查看電機(jī)角度、速度和電流數(shù)據(jù)連接線電機(jī)三相線 U/V/W、編碼器連線、電源線建議使用不同顏色區(qū)分如果你是第一次接觸 FOC更推薦“主控 驅(qū)動(dòng) 電機(jī)”一體化的教學(xué)板。這類板卡出廠前已經(jīng)驗(yàn)證過硬件排除了大部分焊接和接線問題你的精力就能放在軟件調(diào)試上。3.2 軟件環(huán)境軟件部分建議準(zhǔn)備這三樣Arduino IDE 或 STM32CubeIDE。如果使用 SimpleFOC 庫(kù)Arduino IDE 最省事庫(kù)管理器直接安裝。SimpleFOC 庫(kù)。SimpleFOC 是一個(gè)開源的 FOC 控制庫(kù)支持多種 MCU 方案API 設(shè)計(jì)對(duì)初學(xué)者友好自動(dòng)幫你處理坐標(biāo)變換、SVPWM 和 PID 控制器。串口監(jiān)視器或簡(jiǎn)單的上位機(jī)。用于發(fā)送開環(huán)指令和讀取反饋數(shù)據(jù)也可以用來在線修改 PID 參數(shù)。3.3 環(huán)境檢查清單在通電之前檢查以下幾點(diǎn)電源電壓是否與電機(jī)額定電壓匹配。驅(qū)動(dòng)板邏輯供電和控制板供電是否正常。編碼器接線是否按 A/B/Z 或 SDA/SCL 對(duì)應(yīng)正確。三相線 U/V/W 是否順序正確接反會(huì)導(dǎo)致電機(jī)抖動(dòng)或無法啟動(dòng)。串口波特率與程序配置是否一致。這套清單看起來基礎(chǔ)但大部分 FOC 入門翻車都出在接線上。先花十分鐘檢查硬件比你燒了驅(qū)動(dòng)板再去排查省時(shí)間得多。4. 開環(huán)控制實(shí)操讓電機(jī)先轉(zhuǎn)起來4.1 為什么先跑開環(huán)FOC 閉環(huán)控制需要轉(zhuǎn)子位置、電流反饋、速度反饋任何一個(gè)反饋出問題電機(jī)都轉(zhuǎn)不好。而開環(huán)控制不需要任何反饋它直接給三相繞組通以按照期望角度變化的電壓矢量讓電機(jī)跟著磁場(chǎng)方向旋轉(zhuǎn)。因此開環(huán)的價(jià)值非常明顯驗(yàn)證驅(qū)動(dòng)板三相輸出是否正常。驗(yàn)證電機(jī)三相繞組是否完好。驗(yàn)證電源容量是否足夠。驗(yàn)證代碼編譯、燒錄、串口通信鏈路是否通順。如果開環(huán)都轉(zhuǎn)不起來不要急著去調(diào)什么電流環(huán)先把硬件和代碼鏈路查清楚。4.2 開環(huán)控制原理FOC 里開環(huán)控制的本質(zhì)是給定一個(gè)期望的轉(zhuǎn)子電角度通過逆變器在電機(jī)三相上合成對(duì)應(yīng)方向的電壓矢量。簡(jiǎn)單理解就是你想讓轉(zhuǎn)子轉(zhuǎn)到 30 度就合成一個(gè) 30 度方向的磁場(chǎng)轉(zhuǎn)子會(huì)被吸過去。當(dāng)你讓這個(gè)角度隨時(shí)間連續(xù)增大電機(jī)就會(huì)連續(xù)旋轉(zhuǎn)。所以開環(huán) FOC 的關(guān)鍵參數(shù)有電壓幅值也就是目標(biāo)電壓矢量的大小。電壓角度也就是目標(biāo)磁場(chǎng)的電角度。角速度也就是電角度每秒變化的速度。在 SimpleFOC 中可以用setPhaseVoltage(voltage, angle)這樣的接口直接設(shè)置目標(biāo)電壓矢量的幅值和角度從而實(shí)現(xiàn)開環(huán)控制。4.3 開環(huán)測(cè)試的代碼框架下面給一個(gè)基于 SimpleFOC 的開環(huán)測(cè)試示例以 Arduino/STM32 平臺(tái)為例。這個(gè)示例的重點(diǎn)不是完整代碼而是讓你理解開環(huán) FOC 的基本結(jié)構(gòu)。#include SimpleFOC.h // 定義驅(qū)動(dòng)器和電機(jī) BLDCDriver6PWM driver BLDCDriver6PWM(PA8, PA9, PA10, PA11, PA12, PA13); BLDCMotor motor BLDCMotor(7); // 7 對(duì)極按實(shí)際電機(jī)修改 InlineCurrentSense current_sense InlineCurrentSense(0.01f, 50.0f, A0, A1, A2); void setup() { // 初始化驅(qū)動(dòng)器 driver.voltage_power_supply 12.0f; // 電源電壓按實(shí)際修改 driver.init(); motor.linkDriver(driver); // 初始化電流采樣開環(huán)階段可以先不接電流傳感器 current_sense.linkDriver(driver); current_sense.init(); current_sense.enable(); motor.linkCurrentSense(current_sense); // 串口調(diào)試 Serial.begin(115200); motor.useMonitoring(Serial); // 開環(huán)模式 motor.controller MotionControlType::openloop; // 默認(rèn)電壓幅值和角度 motor.voltage_limit 2.0f; // 不要一開始就給太大電壓 motor.openloop_torque_limit 2.0f; motor.init(); } void loop() { // 開環(huán)控制給定目標(biāo)電角度這里讓它旋轉(zhuǎn) motor.move(2 * PI * 1.0f); // 1 圈每秒按實(shí)際需要修改 // 輸出角度和速度到串口 motor.monitor(); delay(10); }注意這個(gè)示例只是一個(gè)框架具體引腳和參數(shù)需要按照你的板子和電機(jī)型號(hào)修改。4.4 開環(huán)測(cè)試步驟第一步燒錄程序打開串口監(jiān)視器波特率設(shè)置與代碼一致。第二步觀察電機(jī)狀態(tài)。通電后如果電機(jī)沒有任何反應(yīng)說明驅(qū)動(dòng)板輸出可能沒使能或者電壓幅值太小。第三步緩慢增加motor.voltage_limit從 1V 開始逐步加到電機(jī)能平穩(wěn)轉(zhuǎn)動(dòng)。如果電壓太大電機(jī)會(huì)猛轉(zhuǎn)甚至過流保護(hù)。第四步調(diào)整motor.move()的目標(biāo)速度觀察電機(jī)轉(zhuǎn)速是否隨設(shè)定值變化。第五步如果電機(jī)抖動(dòng)、異響、反轉(zhuǎn)優(yōu)先檢查三相線順序和驅(qū)動(dòng)板 PWM 輸出是否正常。記住開環(huán)階段不要求電機(jī)轉(zhuǎn)得很穩(wěn)只要它能連續(xù)轉(zhuǎn)就證明你的驅(qū)動(dòng)鏈路已經(jīng)通了可以進(jìn)入下一步閉環(huán)控制。5. 從開環(huán)到閉環(huán)的關(guān)鍵編碼器校準(zhǔn)5.1 為什么需要編碼器FOC 閉環(huán)最核心的反饋是轉(zhuǎn)子電角度。你要知道轉(zhuǎn)子現(xiàn)在在那個(gè)位置才能算出該往哪個(gè)方向施加電流。沒有這個(gè)角度電流環(huán)和速度環(huán)全部失效。因此從開環(huán)轉(zhuǎn)到閉環(huán)之前必須先確保編碼器數(shù)據(jù)可讀、角度方向正確、零點(diǎn)偏移已知。5.2 編碼器與電角度的關(guān)系機(jī)械角度和電角度不同。對(duì)于一個(gè) N 對(duì)極的電機(jī)轉(zhuǎn)子每轉(zhuǎn)一圈電角度會(huì)變化 N 圈。FOC 計(jì)算坐標(biāo)變換時(shí)使用的角度必須是電角度而不是機(jī)械角度。電角度與機(jī)械角度的關(guān)系是電角度 機(jī)械角度 × 極對(duì)數(shù)所以在代碼里Motor 初始化時(shí)傳入極對(duì)數(shù)非常關(guān)鍵。極對(duì)數(shù)不對(duì)FOC 的輸出磁場(chǎng)方向會(huì)亂電機(jī)根本轉(zhuǎn)不動(dòng)。5.3 編碼器零點(diǎn)校準(zhǔn)常用方法是“對(duì)齊”操作給電機(jī)施加一個(gè)已知方向的電壓矢量讓轉(zhuǎn)子磁極被吸引到固定位置然后讀取編碼器的角度值即可得到零點(diǎn)偏移。在 SimpleFOC 中可以通過motor.initFOC()自動(dòng)完成對(duì)齊或者手動(dòng)讀取編碼器值后寫入偏移。操作順序建議如下第一步開環(huán)狀態(tài)下給一個(gè)固定方向的電壓矢量例如setPhaseVoltage(2.0f, 0.0f)讓電機(jī)鎖定到一個(gè)穩(wěn)定位置。第二步讀取編碼器角度值encoder.getAngle()記下這個(gè)角度。第三步將角度偏移寫入程序讓 FOC 計(jì)算的電角度與實(shí)際轉(zhuǎn)子位置對(duì)齊。在 SimpleFOC 中motor.sensor_direction和motor.zero_electric_angle就是用來配置方向和零點(diǎn)偏移的。5.4 編碼器正反向測(cè)試還要確認(rèn)編碼器角度隨手轉(zhuǎn)動(dòng)是增加還是減小。如果方向反了FOC 閉環(huán)會(huì)讓系統(tǒng)正反饋電機(jī)劇烈抖動(dòng)?？梢杂眠@樣的方式判斷手動(dòng)緩慢轉(zhuǎn)動(dòng)電機(jī)觀察串口輸出的角度是增大還是減小然后在代碼里設(shè)置motor.sensor_direction Direction::CCW或Direction::CW來匹配。5.5 編碼器校準(zhǔn)檢查清單編碼器讀數(shù)是否與電機(jī)轉(zhuǎn)動(dòng)方向一致。零點(diǎn)偏移是否在電機(jī)鎖定位置附近。電角度計(jì)算是否連續(xù)有沒有跳變。極對(duì)數(shù)設(shè)置是否正確。這三項(xiàng)確認(rèn)后你就可以進(jìn)入真正的 FOC 閉環(huán)控制調(diào)試了。6. FOC 核心算法拆解從三個(gè)變換到三個(gè)環(huán)先把結(jié)論放前面FOC 的算法并不是玄學(xué)它本質(zhì)上是把三相交流電流轉(zhuǎn)換到轉(zhuǎn)子同步旋轉(zhuǎn)坐標(biāo)系里變成容易控制的直流分量然后用 PI 控制器去調(diào)節(jié)這兩個(gè)直流分量。下面按實(shí)際執(zhí)行順序拆開講。6.1 Clark 變換三相到兩相電機(jī)三相電流 Ia、Ib、Ic 在物理上互差 120 度直接控制很難。Clark 變換把它們映射到兩相靜止坐標(biāo)系α-β 軸得到 Iα、Iβ而 Iα、Iβ 仍然是交流量。這一步的目的只有一個(gè)把三個(gè)變量化簡(jiǎn)成兩個(gè)變量。Clark 變換公式Iα Ia Iβ (Ia 2Ib) / √3這個(gè)公式的推導(dǎo)過程可以以后再看實(shí)際使用中庫(kù)函數(shù)已經(jīng)封裝好了。你只需要知道經(jīng)過 Clark 變換后電流量從三相變成兩相后續(xù)再利用角度轉(zhuǎn)成直流量。6.2 Park 變換兩相靜止到兩相旋轉(zhuǎn)Park 變換利用轉(zhuǎn)子電角度 θ把 α-β 軸系旋轉(zhuǎn)到 d-q 軸系。d 軸與轉(zhuǎn)子磁極方向?qū)Rq 軸垂直于 d 軸。經(jīng)過 Park 變換后你得到 Id 和 Iq。Id 控制磁場(chǎng)強(qiáng)度通常在表貼式電機(jī)上想讓 Id 為 0。Iq 控制力矩大小FOC 的力矩輸出主要靠 Iq。這就是為什么 FOC 能高性能地控制電機(jī)因?yàn)?Iq 是直流量你可以用一個(gè)普通 PID 或 PI 控制器去控制和調(diào)節(jié)它而不需要處理三相交流量。6.3 電流環(huán) PI 控制電流環(huán)是 FOC 的最內(nèi)環(huán)。它采集三相電流經(jīng)過 Clark 和 Park 變換得到 Id 和 Iq 反饋值再與目標(biāo)值做差經(jīng)過 PI 控制器輸出 d-q 軸電壓指令。電流環(huán)的目標(biāo)是讓實(shí)際電流快速跟隨目標(biāo)電流。這個(gè)環(huán)的響應(yīng)速度決定了整個(gè) FOC 系統(tǒng)的動(dòng)態(tài)性能。電流環(huán)整定時(shí)需要注意先調(diào)節(jié) q 軸電流環(huán)因?yàn)?Iq 直接對(duì)應(yīng)力矩。在給定 Iq 目標(biāo)值時(shí)觀察電流反饋是否快速跟蹤。如果系統(tǒng)振蕩減小 P 值或增加 D 值一般電流環(huán)不建議用過大積分項(xiàng)。6.4 速度環(huán)和位置環(huán)速度環(huán)是電流環(huán)的外環(huán)位置環(huán)又是速度環(huán)的外環(huán)。典型的三環(huán)結(jié)構(gòu)是位置環(huán) - 速度環(huán) - 電流環(huán) - Park/Clark - SVPWM - 電機(jī)位置環(huán)輸出速度目標(biāo)值。速度環(huán)輸出電流目標(biāo)值。電流環(huán)輸出電壓目標(biāo)值。調(diào)試順序從內(nèi)到外先整定電流環(huán)再整定速度環(huán)最后整定位置環(huán)。一定不要倒過來。6.5 SVPWM從電壓向量到 PWM 輸出FOC 計(jì)算出 d-q 軸電壓后還要經(jīng)過逆 Park 變換回到 α-β 軸系然后通過空間矢量調(diào)制SVPWM生成三相上橋臂的占空比信號(hào)最后送到驅(qū)動(dòng)板的功率管。SVPWM 的作用是盡可能利用母線電壓同時(shí)讓三相輸出電壓的諧波最小。這個(gè)環(huán)節(jié)與電機(jī)本體無關(guān)更像是一個(gè)數(shù)學(xué)優(yōu)化問題通常固件庫(kù)已經(jīng)幫你處理好了。6.6 無感 FOC 是什么如果你去掉編碼器轉(zhuǎn)子的位置就只能通過反電動(dòng)勢(shì)觀測(cè)器來估算這就變成了無感 FOC。常見的無感方案包括滑模觀測(cè)器、龍伯格觀測(cè)器、擴(kuò)展卡爾曼濾波等。無感 FOC 的難點(diǎn)在于低速時(shí)反電動(dòng)勢(shì)太小觀測(cè)器難以估算出可靠角度。很多電調(diào)之所以在低速或帶負(fù)載啟動(dòng)時(shí)容易失步根本原因就在這里。對(duì)入門來說先做好有傳感器 FOC 更重要。有感方案調(diào)試成功再去把傳感器替換成觀測(cè)器你會(huì)更容易理解哪里會(huì)影響估算精度。7. 功能測(cè)試進(jìn)階從電流環(huán)到三環(huán)7.1 電流環(huán)測(cè)試方法電流環(huán)是 FOC 的核心測(cè)試時(shí)建議逐步加大目標(biāo)電流測(cè)試步驟操作預(yù)期結(jié)果1設(shè)置 Id 目標(biāo)為 0Iq 目標(biāo)為 0電機(jī)靜止電流接近 02設(shè)置 Iq 目標(biāo)為 0.5A電機(jī)出現(xiàn)恒定力矩響應(yīng)快速3緩慢增加 Iq 到 1A電機(jī)力矩增大電流反饋平穩(wěn)4施加外部阻力電流環(huán)應(yīng)維持目標(biāo)電流轉(zhuǎn)速下降測(cè)試電流環(huán)時(shí)一定要把速度給到很小或者直接堵轉(zhuǎn)測(cè)試以防電機(jī)飛車。7.2 速度環(huán)測(cè)試方法速度環(huán)測(cè)試建議從 0 開始逐步增加目標(biāo)速度給一個(gè)較低的目標(biāo)速度比如每秒 1 圈觀察穩(wěn)定時(shí)間。增大速度觀察速度反饋是否出現(xiàn)超調(diào)和振蕩。突然改變目標(biāo)速度觀察響應(yīng)速度。如果速度環(huán)振蕩典型處理方法是減小 P增大 I或者檢查電流環(huán)帶寬是否足夠。7.3 位置環(huán)測(cè)試方法位置環(huán)適合驗(yàn)證最終控制效果給一個(gè)固定的位置指令觀察是否準(zhǔn)確到位是否過沖。給一個(gè)正弦變化的位置軌跡觀察跟蹤誤差。用手撥動(dòng)電機(jī)觀察位置環(huán)的回復(fù)力大小。位置環(huán)的核心問題是阻尼。沒有足夠阻尼電機(jī)容易在目標(biāo)位置附近來回晃動(dòng)。7.4 波形觀察與數(shù)據(jù)記錄調(diào)試 FOC 不能只靠感覺要有波形數(shù)據(jù)作為依據(jù)。建議把角度、速度、電流數(shù)據(jù)通過串口輸出到上位機(jī)或者保存到 SD 卡。常用的調(diào)試工具有Serial Plotter適合簡(jiǎn)單波形觀察。SimpleFOC Studio適合調(diào)參和記錄數(shù)據(jù)。邏輯分析儀用于觀察 PWM 和編碼器信號(hào)時(shí)序。示波器用于電流采樣和電壓波形分析。觀察波形時(shí)重點(diǎn)看四個(gè)東西電流響應(yīng)是否平滑、速度反饋是否穩(wěn)定、角度反饋是否連續(xù)、控制量是否存在振蕩。8. 常見問題與排查方法問題現(xiàn)象可能原因排查方式解決方案上電后電機(jī)不轉(zhuǎn)電壓幅值太小、驅(qū)動(dòng)板輸出未使能檢查電壓設(shè)置和 PWM 輸出增大 voltage_limit查看驅(qū)動(dòng)板使能引腳電機(jī)抖動(dòng)、異響三相線順序錯(cuò)誤、極對(duì)數(shù)設(shè)置錯(cuò)誤檢查三相接線對(duì)比電機(jī)參數(shù)交換任意兩相線核對(duì)極對(duì)數(shù)編碼器數(shù)據(jù)無反饋編碼器接線錯(cuò)誤或供電不足串口打印編碼器角度手動(dòng)轉(zhuǎn)動(dòng)電機(jī)檢查 VCC/GND/A/B 接線改用獨(dú)立供電電機(jī)越轉(zhuǎn)越抖編碼器方向反了觀察角度方向與電機(jī)轉(zhuǎn)向關(guān)系設(shè)置 sensor_direction 為相反方向閉環(huán)時(shí)電機(jī)失控零點(diǎn)偏移不對(duì)重新校準(zhǔn)零點(diǎn)重新執(zhí)行 initFOC 或手動(dòng)寫入偏移電流環(huán)振蕩PID 參數(shù)過高或電流采樣噪聲大增大采樣濾波降低 P降低 P增加濾波再調(diào) I電機(jī)帶載轉(zhuǎn)速掉得多電壓或電流限制太小查看電壓占用和電流限制提高 voltage_limit、current_limit串口數(shù)據(jù)亂碼波特率不匹配檢查波特率設(shè)置統(tǒng)一串口波特率電機(jī)發(fā)熱嚴(yán)重電流過大或 Id 不為 0檢查 Iq、Id 反饋設(shè)置 Id0降低電流上限排查問題時(shí)有一條原則一次只改一個(gè)變量。不要同時(shí)調(diào)整 PID、換編碼器方向、改電源電壓否則出了問題你根本不知道是哪一項(xiàng)引起的。另外建議在代碼里加上錯(cuò)誤診斷輸出把電壓、電流、角度、溫度分別打出來配合串口繪圖工具就能把問題逐步縮小范圍。9. 最佳實(shí)踐與學(xué)習(xí)建議9.1 硬件層面的建議電機(jī)一定要固定牢靠最好用臺(tái)鉗或支架否則高速旋轉(zhuǎn)時(shí)可能飛出去。三相線盡量用快接端子或焊盤連接不要用粗糙的杜邦線接觸不良會(huì)造成電流毛刺?？刂瓢搴万?qū)動(dòng)板共地否則編碼器信號(hào)和電流采樣會(huì)異常。電源輸入端加上大電容避免電機(jī)啟停造成母線電壓跌落。9.2 軟件層面的建議第一次燒錄時(shí)把所有限制都調(diào)到最小低電壓、低電流、低速度。開環(huán)階段先不接入電流傳感器減少變量。閉環(huán)調(diào)試從電流環(huán)開始電流環(huán)穩(wěn)定后再調(diào)速度環(huán)最后才是位置環(huán)。每次修改參數(shù)后記錄修改內(nèi)容不要靠記憶。9.3 學(xué)習(xí)路線的建議如果你完全從零開始建議按下面的順序推進(jìn)先跑通開環(huán)轉(zhuǎn)動(dòng)確認(rèn)硬件鏈路。用串口讀取編碼器角度理解機(jī)械角度和電角度的關(guān)系。完成編碼器方向與零點(diǎn)校準(zhǔn)。接通電流采樣調(diào)通電流環(huán)。在電流環(huán)基礎(chǔ)上加速度環(huán)。最后加位置環(huán)完成三環(huán)串聯(lián)。有精力再研究無感 FOC 或更高性能的控制算法。關(guān)注以下幾個(gè)高頻搜索詞對(duì)深入理解 FOC 很有幫助FOC 電流采樣為什么設(shè)置在下橋、FOC 三環(huán)頻率、FOC 電流環(huán)、FOC 控制調(diào)試、PMSM 無感 FOC 控制、FOC 算法詳解、電機(jī) FOC 控制原理、FOC 驅(qū)動(dòng)速度環(huán)設(shè)計(jì)。這些關(guān)鍵詞分別對(duì)應(yīng) FOC 中“采樣時(shí)機(jī)”“控制帶寬”“坐標(biāo)變換”“觀測(cè)器設(shè)計(jì)”等不同知識(shí)點(diǎn)。建議每做完一個(gè)實(shí)驗(yàn)就搜一個(gè)對(duì)應(yīng)的關(guān)鍵詞來看效果比連續(xù)刷三天視頻好很多。另外還有幾個(gè)容易被忽視但非常重要的知識(shí)點(diǎn)FOC 的 Iq 是怎么產(chǎn)生磁場(chǎng)的、FOC 電調(diào)是否開啟同步整流、SVPWM 中直流母線電壓利用率的計(jì)算、不同負(fù)載條件下電流采樣窗口如何保證。這些問題雖然看起來偏理論但實(shí)際調(diào)參會(huì)直接遇到。10. 總結(jié)與下一步FOC 入門最值得先做的兩件事一是用開環(huán)控制把電機(jī)轉(zhuǎn)起來二是把編碼器角度反饋調(diào)準(zhǔn)。這兩步做完你的軟硬件鏈路已經(jīng)成立后面的電流環(huán)、速度環(huán)、位置環(huán)都是在這個(gè)基礎(chǔ)上加控制層而已。最容易踩的坑無非是三相線接錯(cuò)、編碼器方向搞反、零點(diǎn)偏了這幾種。這些問題排查方法上面都給了你只需要在出問題時(shí)冷靜地一次改一個(gè)變量。接下來值得你繼續(xù)往前走的幾個(gè)方向在現(xiàn)有硬件上完成電流環(huán)閉環(huán)觀察 Iq 和 Id 的波形體會(huì) Park 變換帶來的“直流化”效果。把速度環(huán)加上對(duì)比開環(huán)和閉環(huán)的轉(zhuǎn)速穩(wěn)定性差異。研究 SVPWM 的實(shí)現(xiàn)理解空間電壓矢量與三相占空比的關(guān)系。嘗試無感 FOC把編碼器換成反電動(dòng)勢(shì)觀測(cè)器。用 Simulink 或 Python 搭一套 FOC 仿真模型把算法在離線環(huán)境里跑透再回到硬件驗(yàn)證。建議先把這套流程跑通兩遍第一遍照著做第二遍把每個(gè)函數(shù)背后的原理查一遍。真正吃透 FOC并不需要你把所有公式推導(dǎo)得多么熟練而是要在調(diào)試中建立“現(xiàn)象-參數(shù)-算法”的對(duì)應(yīng)關(guān)系。電機(jī)轉(zhuǎn)不轉(zhuǎn)、穩(wěn)不穩(wěn)、響不響應(yīng)都能讓你快速定位是哪一環(huán)出了問題這才是入門到進(jìn)階的關(guān)鍵能力。 FOC入門實(shí)操：開環(huán)轉(zhuǎn)動(dòng)、編碼器校準(zhǔn)到三環(huán)閉環(huán)調(diào)試
先給結(jié)論如果你正在研究 FOC但又被 Clark 變換、Park 變換、SVPWM、PID 整定這些概念勸退那這篇文章就是給你寫的。正確的入門路徑不是一上來就啃算法推導(dǎo)而是先用最簡(jiǎn)單的開環(huán)控制讓電機(jī)轉(zhuǎn)起來確認(rèn)硬件、驅(qū)動(dòng)板、電源、編碼器全部正常然后再一步步往閉環(huán)算法里加?xùn)|西。電機(jī)能轉(zhuǎn)你就已經(jīng)走完了 FOC 入門最難的一大半。這次我們直接進(jìn)入實(shí)操層面。文章會(huì)先梳理 FOC 入門需要準(zhǔn)備哪些硬件和軟件然后帶你完成一次開環(huán)轉(zhuǎn)動(dòng)測(cè)試再做編碼器零點(diǎn)校準(zhǔn)最后把 FOC 的核心算法框架拆開講明白。整個(gè)過程不追求一次到位目標(biāo)是讓你有一個(gè)能跑、能調(diào)、能觀察波形的 FOC 調(diào)試環(huán)境。讀完你可以拿著這塊板子繼續(xù)做電流環(huán)、速度環(huán)、位置環(huán)的實(shí)驗(yàn)而不是停留在“看過原理”的階段。1. 核心能力速覽先給一張速覽表把 FOC 入門階段最關(guān)心的幾個(gè)問題一次性說清楚。能力項(xiàng)說明控制對(duì)象永磁同步電機(jī)PMSM、無刷直流電機(jī)BLDC帶編碼器反饋開環(huán)控制支持適合硬件自檢、電機(jī)確認(rèn)、初始轉(zhuǎn)動(dòng)測(cè)試閉環(huán)算法電流環(huán)、速度環(huán)、位置環(huán)從單環(huán)到三環(huán)逐級(jí)增加電流采樣一般使用雙電阻或三電阻下橋采樣部分方案也用單電阻推薦硬件常見 STM32 開發(fā)板、SimpleFOC 驅(qū)動(dòng)板、一體化驅(qū)動(dòng)板均適用軟件環(huán)境Arduino IDE、SimpleFOC 庫(kù)、STM32CubeMX 等按你的 MCU 方案選擇顯存需求無純嵌入式項(xiàng)目不涉及 GPU 或本地模型推理啟動(dòng)方式編譯燒錄啟動(dòng)上位機(jī)一般通過串口連接接口能力串口指令控制可通過串口修改 PID 參數(shù)、讀取角度速度和電流數(shù)據(jù)批量任務(wù)不適用FOC 是實(shí)時(shí)控制任務(wù)不是離線批量任務(wù)場(chǎng)景適學(xué)人群嵌入式開發(fā)者、機(jī)器人愛好者、無人機(jī)/云臺(tái)調(diào)參工程師、學(xué)生從這張表能看出FOC 入門階段的重點(diǎn)不在“裝環(huán)境”而在“把硬件和代碼配合起來”。軟硬件鏈路一旦跑通后面做閉環(huán)就是調(diào)參工作。2. 適用場(chǎng)景與使用邊界2.1 適合哪些場(chǎng)景FOC 適用的場(chǎng)景很廣常見的包括云臺(tái)電機(jī)控制要求力矩平穩(wěn)、響應(yīng)快、位置精確。小型機(jī)器人關(guān)節(jié)需要位置環(huán)和速度環(huán)配合。無人機(jī)無刷電機(jī)驅(qū)動(dòng)追求效率和高動(dòng)態(tài)響應(yīng)。工業(yè)伺服入門學(xué)習(xí)理解電流環(huán)-速度環(huán)-位置環(huán)的嵌套關(guān)系。無感 FOC 研究先通過有感 FOC 驗(yàn)證算法再去掉編碼器做無感觀測(cè)器。如果你是初學(xué)者最合適的場(chǎng)景就是“桌面級(jí)硬件 開環(huán)轉(zhuǎn)動(dòng) 編碼器校準(zhǔn) 單電流環(huán)調(diào)試”。這套流程成本低風(fēng)險(xiǎn)小而且能覆蓋 FOC 最核心的知識(shí)點(diǎn)。2.2 不適合哪些場(chǎng)景純軟件學(xué)習(xí)、不打算碰硬件的同學(xué)。FOC 還是要實(shí)際操作才能理解沒有真實(shí)電機(jī)反饋很多概念很難建立直覺。需要超高功率驅(qū)動(dòng)的工業(yè)場(chǎng)景。入門級(jí)驅(qū)動(dòng)板和低壓電機(jī)不適合直接放大功率否則容易燒板子。想“零基礎(chǔ)一次看懂全部 FOC 公式推導(dǎo)”的同學(xué)。FOC 涉及較多坐標(biāo)變換和 PI 調(diào)節(jié)理論建議先操作后理論或者邊操作邊看公式。2.3 合規(guī)與安全邊界FOC 調(diào)試涉及電機(jī)轉(zhuǎn)動(dòng)和電流采樣有三點(diǎn)必須注意實(shí)驗(yàn)環(huán)境要固定好電機(jī)防止電機(jī)高速旋轉(zhuǎn)時(shí)飛出傷人。電源要選擇合適的限流不要超過驅(qū)動(dòng)板和電機(jī)的額定值。調(diào)試閉環(huán)時(shí)先給較小的電流和速度限制不要一開始就跑滿占空比。另外如果后續(xù)把 FOC 用于實(shí)際產(chǎn)品一定要確認(rèn)電機(jī)的使用許可、驅(qū)動(dòng)方案的可靠性以及相關(guān)安全認(rèn)證。FOC 本身是完全開放的控制技術(shù)不涉及版權(quán)問題但不同硬件方案的固件和驅(qū)動(dòng)代碼需要遵守對(duì)應(yīng)開源協(xié)議。3. 環(huán)境準(zhǔn)備與前置條件3.1 硬件清單做 FOC 入門不需要特別昂貴的設(shè)備。一套典型的實(shí)驗(yàn)環(huán)境如下硬件說明帶編碼器的無刷電機(jī)常見的有感無刷電機(jī)如云臺(tái)電機(jī)、FOC 專用教學(xué)電機(jī)編碼器建議選用磁編碼器或 ABZ 增量編碼器FOC 驅(qū)動(dòng)板常見方案為 SimpleFOC Shield、基于 DRV8301/DRV8302 的驅(qū)動(dòng)板、或帶電流采樣的集成驅(qū)動(dòng)板主控板STM32F103/F405、Arduino UNO、Arduino Due、ESP32 等選型取決于驅(qū)動(dòng)板和算法復(fù)雜度直流電源一般 12V 或 24V 低壓電源注意電流能力要滿足電機(jī)峰值串口調(diào)試工具USB-TTL 串口模塊用于查看電機(jī)角度、速度和電流數(shù)據(jù)連接線電機(jī)三相線 U/V/W、編碼器連線、電源線建議使用不同顏色區(qū)分如果你是第一次接觸 FOC更推薦“主控 驅(qū)動(dòng) 電機(jī)”一體化的教學(xué)板。這類板卡出廠前已經(jīng)驗(yàn)證過硬件排除了大部分焊接和接線問題你的精力就能放在軟件調(diào)試上。3.2 軟件環(huán)境軟件部分建議準(zhǔn)備這三樣Arduino IDE 或 STM32CubeIDE。如果使用 SimpleFOC 庫(kù)Arduino IDE 最省事庫(kù)管理器直接安裝。SimpleFOC 庫(kù)。SimpleFOC 是一個(gè)開源的 FOC 控制庫(kù)支持多種 MCU 方案API 設(shè)計(jì)對(duì)初學(xué)者友好自動(dòng)幫你處理坐標(biāo)變換、SVPWM 和 PID 控制器。串口監(jiān)視器或簡(jiǎn)單的上位機(jī)。用于發(fā)送開環(huán)指令和讀取反饋數(shù)據(jù)也可以用來在線修改 PID 參數(shù)。3.3 環(huán)境檢查清單在通電之前檢查以下幾點(diǎn)電源電壓是否與電機(jī)額定電壓匹配。驅(qū)動(dòng)板邏輯供電和控制板供電是否正常。編碼器接線是否按 A/B/Z 或 SDA/SCL 對(duì)應(yīng)正確。三相線 U/V/W 是否順序正確接反會(huì)導(dǎo)致電機(jī)抖動(dòng)或無法啟動(dòng)。串口波特率與程序配置是否一致。這套清單看起來基礎(chǔ)但大部分 FOC 入門翻車都出在接線上。先花十分鐘檢查硬件比你燒了驅(qū)動(dòng)板再去排查省時(shí)間得多。4. 開環(huán)控制實(shí)操讓電機(jī)先轉(zhuǎn)起來4.1 為什么先跑開環(huán)FOC 閉環(huán)控制需要轉(zhuǎn)子位置、電流反饋、速度反饋任何一個(gè)反饋出問題電機(jī)都轉(zhuǎn)不好。而開環(huán)控制不需要任何反饋它直接給三相繞組通以按照期望角度變化的電壓矢量讓電機(jī)跟著磁場(chǎng)方向旋轉(zhuǎn)。因此開環(huán)的價(jià)值非常明顯驗(yàn)證驅(qū)動(dòng)板三相輸出是否正常。驗(yàn)證電機(jī)三相繞組是否完好。驗(yàn)證電源容量是否足夠。驗(yàn)證代碼編譯、燒錄、串口通信鏈路是否通順。如果開環(huán)都轉(zhuǎn)不起來不要急著去調(diào)什么電流環(huán)先把硬件和代碼鏈路查清楚。4.2 開環(huán)控制原理FOC 里開環(huán)控制的本質(zhì)是給定一個(gè)期望的轉(zhuǎn)子電角度通過逆變器在電機(jī)三相上合成對(duì)應(yīng)方向的電壓矢量。簡(jiǎn)單理解就是你想讓轉(zhuǎn)子轉(zhuǎn)到 30 度就合成一個(gè) 30 度方向的磁場(chǎng)轉(zhuǎn)子會(huì)被吸過去。當(dāng)你讓這個(gè)角度隨時(shí)間連續(xù)增大電機(jī)就會(huì)連續(xù)旋轉(zhuǎn)。所以開環(huán) FOC 的關(guān)鍵參數(shù)有電壓幅值也就是目標(biāo)電壓矢量的大小。電壓角度也就是目標(biāo)磁場(chǎng)的電角度。角速度也就是電角度每秒變化的速度。在 SimpleFOC 中可以用setPhaseVoltage(voltage, angle)這樣的接口直接設(shè)置目標(biāo)電壓矢量的幅值和角度從而實(shí)現(xiàn)開環(huán)控制。4.3 開環(huán)測(cè)試的代碼框架下面給一個(gè)基于 SimpleFOC 的開環(huán)測(cè)試示例以 Arduino/STM32 平臺(tái)為例。這個(gè)示例的重點(diǎn)不是完整代碼而是讓你理解開環(huán) FOC 的基本結(jié)構(gòu)。#include SimpleFOC.h // 定義驅(qū)動(dòng)器和電機(jī) BLDCDriver6PWM driver BLDCDriver6PWM(PA8, PA9, PA10, PA11, PA12, PA13); BLDCMotor motor BLDCMotor(7); // 7 對(duì)極按實(shí)際電機(jī)修改 InlineCurrentSense current_sense InlineCurrentSense(0.01f, 50.0f, A0, A1, A2); void setup() { // 初始化驅(qū)動(dòng)器 driver.voltage_power_supply 12.0f; // 電源電壓按實(shí)際修改 driver.init(); motor.linkDriver(driver); // 初始化電流采樣開環(huán)階段可以先不接電流傳感器 current_sense.linkDriver(driver); current_sense.init(); current_sense.enable(); motor.linkCurrentSense(current_sense); // 串口調(diào)試 Serial.begin(115200); motor.useMonitoring(Serial); // 開環(huán)模式 motor.controller MotionControlType::openloop; // 默認(rèn)電壓幅值和角度 motor.voltage_limit 2.0f; // 不要一開始就給太大電壓 motor.openloop_torque_limit 2.0f; motor.init(); } void loop() { // 開環(huán)控制給定目標(biāo)電角度這里讓它旋轉(zhuǎn) motor.move(2 * PI * 1.0f); // 1 圈每秒按實(shí)際需要修改 // 輸出角度和速度到串口 motor.monitor(); delay(10); }注意這個(gè)示例只是一個(gè)框架具體引腳和參數(shù)需要按照你的板子和電機(jī)型號(hào)修改。4.4 開環(huán)測(cè)試步驟第一步燒錄程序打開串口監(jiān)視器波特率設(shè)置與代碼一致。第二步觀察電機(jī)狀態(tài)。通電后如果電機(jī)沒有任何反應(yīng)說明驅(qū)動(dòng)板輸出可能沒使能或者電壓幅值太小。第三步緩慢增加motor.voltage_limit從 1V 開始逐步加到電機(jī)能平穩(wěn)轉(zhuǎn)動(dòng)。如果電壓太大電機(jī)會(huì)猛轉(zhuǎn)甚至過流保護(hù)。第四步調(diào)整motor.move()的目標(biāo)速度觀察電機(jī)轉(zhuǎn)速是否隨設(shè)定值變化。第五步如果電機(jī)抖動(dòng)、異響、反轉(zhuǎn)優(yōu)先檢查三相線順序和驅(qū)動(dòng)板 PWM 輸出是否正常。記住開環(huán)階段不要求電機(jī)轉(zhuǎn)得很穩(wěn)只要它能連續(xù)轉(zhuǎn)就證明你的驅(qū)動(dòng)鏈路已經(jīng)通了可以進(jìn)入下一步閉環(huán)控制。5. 從開環(huán)到閉環(huán)的關(guān)鍵編碼器校準(zhǔn)5.1 為什么需要編碼器FOC 閉環(huán)最核心的反饋是轉(zhuǎn)子電角度。你要知道轉(zhuǎn)子現(xiàn)在在那個(gè)位置才能算出該往哪個(gè)方向施加電流。沒有這個(gè)角度電流環(huán)和速度環(huán)全部失效。因此從開環(huán)轉(zhuǎn)到閉環(huán)之前必須先確保編碼器數(shù)據(jù)可讀、角度方向正確、零點(diǎn)偏移已知。5.2 編碼器與電角度的關(guān)系機(jī)械角度和電角度不同。對(duì)于一個(gè) N 對(duì)極的電機(jī)轉(zhuǎn)子每轉(zhuǎn)一圈電角度會(huì)變化 N 圈。FOC 計(jì)算坐標(biāo)變換時(shí)使用的角度必須是電角度而不是機(jī)械角度。電角度與機(jī)械角度的關(guān)系是電角度 機(jī)械角度 × 極對(duì)數(shù)所以在代碼里Motor 初始化時(shí)傳入極對(duì)數(shù)非常關(guān)鍵。極對(duì)數(shù)不對(duì)FOC 的輸出磁場(chǎng)方向會(huì)亂電機(jī)根本轉(zhuǎn)不動(dòng)。5.3 編碼器零點(diǎn)校準(zhǔn)常用方法是“對(duì)齊”操作給電機(jī)施加一個(gè)已知方向的電壓矢量讓轉(zhuǎn)子磁極被吸引到固定位置然后讀取編碼器的角度值即可得到零點(diǎn)偏移。在 SimpleFOC 中可以通過motor.initFOC()自動(dòng)完成對(duì)齊或者手動(dòng)讀取編碼器值后寫入偏移。操作順序建議如下第一步開環(huán)狀態(tài)下給一個(gè)固定方向的電壓矢量例如setPhaseVoltage(2.0f, 0.0f)讓電機(jī)鎖定到一個(gè)穩(wěn)定位置。第二步讀取編碼器角度值encoder.getAngle()記下這個(gè)角度。第三步將角度偏移寫入程序讓 FOC 計(jì)算的電角度與實(shí)際轉(zhuǎn)子位置對(duì)齊。在 SimpleFOC 中motor.sensor_direction和motor.zero_electric_angle就是用來配置方向和零點(diǎn)偏移的。5.4 編碼器正反向測(cè)試還要確認(rèn)編碼器角度隨手轉(zhuǎn)動(dòng)是增加還是減小。如果方向反了FOC 閉環(huán)會(huì)讓系統(tǒng)正反饋電機(jī)劇烈抖動(dòng)?？梢杂眠@樣的方式判斷手動(dòng)緩慢轉(zhuǎn)動(dòng)電機(jī)觀察串口輸出的角度是增大還是減小然后在代碼里設(shè)置motor.sensor_direction Direction::CCW或Direction::CW來匹配。5.5 編碼器校準(zhǔn)檢查清單編碼器讀數(shù)是否與電機(jī)轉(zhuǎn)動(dòng)方向一致。零點(diǎn)偏移是否在電機(jī)鎖定位置附近。電角度計(jì)算是否連續(xù)有沒有跳變。極對(duì)數(shù)設(shè)置是否正確。這三項(xiàng)確認(rèn)后你就可以進(jìn)入真正的 FOC 閉環(huán)控制調(diào)試了。6. FOC 核心算法拆解從三個(gè)變換到三個(gè)環(huán)先把結(jié)論放前面FOC 的算法并不是玄學(xué)它本質(zhì)上是把三相交流電流轉(zhuǎn)換到轉(zhuǎn)子同步旋轉(zhuǎn)坐標(biāo)系里變成容易控制的直流分量然后用 PI 控制器去調(diào)節(jié)這兩個(gè)直流分量。下面按實(shí)際執(zhí)行順序拆開講。6.1 Clark 變換三相到兩相電機(jī)三相電流 Ia、Ib、Ic 在物理上互差 120 度直接控制很難。Clark 變換把它們映射到兩相靜止坐標(biāo)系α-β 軸得到 Iα、Iβ而 Iα、Iβ 仍然是交流量。這一步的目的只有一個(gè)把三個(gè)變量化簡(jiǎn)成兩個(gè)變量。Clark 變換公式Iα Ia Iβ (Ia 2Ib) / √3這個(gè)公式的推導(dǎo)過程可以以后再看實(shí)際使用中庫(kù)函數(shù)已經(jīng)封裝好了。你只需要知道經(jīng)過 Clark 變換后電流量從三相變成兩相后續(xù)再利用角度轉(zhuǎn)成直流量。6.2 Park 變換兩相靜止到兩相旋轉(zhuǎn)Park 變換利用轉(zhuǎn)子電角度 θ把 α-β 軸系旋轉(zhuǎn)到 d-q 軸系。d 軸與轉(zhuǎn)子磁極方向?qū)Rq 軸垂直于 d 軸。經(jīng)過 Park 變換后你得到 Id 和 Iq。Id 控制磁場(chǎng)強(qiáng)度通常在表貼式電機(jī)上想讓 Id 為 0。Iq 控制力矩大小FOC 的力矩輸出主要靠 Iq。這就是為什么 FOC 能高性能地控制電機(jī)因?yàn)?Iq 是直流量你可以用一個(gè)普通 PID 或 PI 控制器去控制和調(diào)節(jié)它而不需要處理三相交流量。6.3 電流環(huán) PI 控制電流環(huán)是 FOC 的最內(nèi)環(huán)。它采集三相電流經(jīng)過 Clark 和 Park 變換得到 Id 和 Iq 反饋值再與目標(biāo)值做差經(jīng)過 PI 控制器輸出 d-q 軸電壓指令。電流環(huán)的目標(biāo)是讓實(shí)際電流快速跟隨目標(biāo)電流。這個(gè)環(huán)的響應(yīng)速度決定了整個(gè) FOC 系統(tǒng)的動(dòng)態(tài)性能。電流環(huán)整定時(shí)需要注意先調(diào)節(jié) q 軸電流環(huán)因?yàn)?Iq 直接對(duì)應(yīng)力矩。在給定 Iq 目標(biāo)值時(shí)觀察電流反饋是否快速跟蹤。如果系統(tǒng)振蕩減小 P 值或增加 D 值一般電流環(huán)不建議用過大積分項(xiàng)。6.4 速度環(huán)和位置環(huán)速度環(huán)是電流環(huán)的外環(huán)位置環(huán)又是速度環(huán)的外環(huán)。典型的三環(huán)結(jié)構(gòu)是位置環(huán) - 速度環(huán) - 電流環(huán) - Park/Clark - SVPWM - 電機(jī)位置環(huán)輸出速度目標(biāo)值。速度環(huán)輸出電流目標(biāo)值。電流環(huán)輸出電壓目標(biāo)值。調(diào)試順序從內(nèi)到外先整定電流環(huán)再整定速度環(huán)最后整定位置環(huán)。一定不要倒過來。6.5 SVPWM從電壓向量到 PWM 輸出FOC 計(jì)算出 d-q 軸電壓后還要經(jīng)過逆 Park 變換回到 α-β 軸系然后通過空間矢量調(diào)制SVPWM生成三相上橋臂的占空比信號(hào)最后送到驅(qū)動(dòng)板的功率管。SVPWM 的作用是盡可能利用母線電壓同時(shí)讓三相輸出電壓的諧波最小。這個(gè)環(huán)節(jié)與電機(jī)本體無關(guān)更像是一個(gè)數(shù)學(xué)優(yōu)化問題通常固件庫(kù)已經(jīng)幫你處理好了。6.6 無感 FOC 是什么如果你去掉編碼器轉(zhuǎn)子的位置就只能通過反電動(dòng)勢(shì)觀測(cè)器來估算這就變成了無感 FOC。常見的無感方案包括滑模觀測(cè)器、龍伯格觀測(cè)器、擴(kuò)展卡爾曼濾波等。無感 FOC 的難點(diǎn)在于低速時(shí)反電動(dòng)勢(shì)太小觀測(cè)器難以估算出可靠角度。很多電調(diào)之所以在低速或帶負(fù)載啟動(dòng)時(shí)容易失步根本原因就在這里。對(duì)入門來說先做好有傳感器 FOC 更重要。有感方案調(diào)試成功再去把傳感器替換成觀測(cè)器你會(huì)更容易理解哪里會(huì)影響估算精度。7. 功能測(cè)試進(jìn)階從電流環(huán)到三環(huán)7.1 電流環(huán)測(cè)試方法電流環(huán)是 FOC 的核心測(cè)試時(shí)建議逐步加大目標(biāo)電流測(cè)試步驟操作預(yù)期結(jié)果1設(shè)置 Id 目標(biāo)為 0Iq 目標(biāo)為 0電機(jī)靜止電流接近 02設(shè)置 Iq 目標(biāo)為 0.5A電機(jī)出現(xiàn)恒定力矩響應(yīng)快速3緩慢增加 Iq 到 1A電機(jī)力矩增大電流反饋平穩(wěn)4施加外部阻力電流環(huán)應(yīng)維持目標(biāo)電流轉(zhuǎn)速下降測(cè)試電流環(huán)時(shí)一定要把速度給到很小或者直接堵轉(zhuǎn)測(cè)試以防電機(jī)飛車。7.2 速度環(huán)測(cè)試方法速度環(huán)測(cè)試建議從 0 開始逐步增加目標(biāo)速度給一個(gè)較低的目標(biāo)速度比如每秒 1 圈觀察穩(wěn)定時(shí)間。增大速度觀察速度反饋是否出現(xiàn)超調(diào)和振蕩。突然改變目標(biāo)速度觀察響應(yīng)速度。如果速度環(huán)振蕩典型處理方法是減小 P增大 I或者檢查電流環(huán)帶寬是否足夠。7.3 位置環(huán)測(cè)試方法位置環(huán)適合驗(yàn)證最終控制效果給一個(gè)固定的位置指令觀察是否準(zhǔn)確到位是否過沖。給一個(gè)正弦變化的位置軌跡觀察跟蹤誤差。用手撥動(dòng)電機(jī)觀察位置環(huán)的回復(fù)力大小。位置環(huán)的核心問題是阻尼。沒有足夠阻尼電機(jī)容易在目標(biāo)位置附近來回晃動(dòng)。7.4 波形觀察與數(shù)據(jù)記錄調(diào)試 FOC 不能只靠感覺要有波形數(shù)據(jù)作為依據(jù)。建議把角度、速度、電流數(shù)據(jù)通過串口輸出到上位機(jī)或者保存到 SD 卡。常用的調(diào)試工具有Serial Plotter適合簡(jiǎn)單波形觀察。SimpleFOC Studio適合調(diào)參和記錄數(shù)據(jù)。邏輯分析儀用于觀察 PWM 和編碼器信號(hào)時(shí)序。示波器用于電流采樣和電壓波形分析。觀察波形時(shí)重點(diǎn)看四個(gè)東西電流響應(yīng)是否平滑、速度反饋是否穩(wěn)定、角度反饋是否連續(xù)、控制量是否存在振蕩。8. 常見問題與排查方法問題現(xiàn)象可能原因排查方式解決方案上電后電機(jī)不轉(zhuǎn)電壓幅值太小、驅(qū)動(dòng)板輸出未使能檢查電壓設(shè)置和 PWM 輸出增大 voltage_limit查看驅(qū)動(dòng)板使能引腳電機(jī)抖動(dòng)、異響三相線順序錯(cuò)誤、極對(duì)數(shù)設(shè)置錯(cuò)誤檢查三相接線對(duì)比電機(jī)參數(shù)交換任意兩相線核對(duì)極對(duì)數(shù)編碼器數(shù)據(jù)無反饋編碼器接線錯(cuò)誤或供電不足串口打印編碼器角度手動(dòng)轉(zhuǎn)動(dòng)電機(jī)檢查 VCC/GND/A/B 接線改用獨(dú)立供電電機(jī)越轉(zhuǎn)越抖編碼器方向反了觀察角度方向與電機(jī)轉(zhuǎn)向關(guān)系設(shè)置 sensor_direction 為相反方向閉環(huán)時(shí)電機(jī)失控零點(diǎn)偏移不對(duì)重新校準(zhǔn)零點(diǎn)重新執(zhí)行 initFOC 或手動(dòng)寫入偏移電流環(huán)振蕩PID 參數(shù)過高或電流采樣噪聲大增大采樣濾波降低 P降低 P增加濾波再調(diào) I電機(jī)帶載轉(zhuǎn)速掉得多電壓或電流限制太小查看電壓占用和電流限制提高 voltage_limit、current_limit串口數(shù)據(jù)亂碼波特率不匹配檢查波特率設(shè)置統(tǒng)一串口波特率電機(jī)發(fā)熱嚴(yán)重電流過大或 Id 不為 0檢查 Iq、Id 反饋設(shè)置 Id0降低電流上限排查問題時(shí)有一條原則一次只改一個(gè)變量。不要同時(shí)調(diào)整 PID、換編碼器方向、改電源電壓否則出了問題你根本不知道是哪一項(xiàng)引起的。另外建議在代碼里加上錯(cuò)誤診斷輸出把電壓、電流、角度、溫度分別打出來配合串口繪圖工具就能把問題逐步縮小范圍。9. 最佳實(shí)踐與學(xué)習(xí)建議9.1 硬件層面的建議電機(jī)一定要固定牢靠最好用臺(tái)鉗或支架否則高速旋轉(zhuǎn)時(shí)可能飛出去。三相線盡量用快接端子或焊盤連接不要用粗糙的杜邦線接觸不良會(huì)造成電流毛刺?？刂瓢搴万?qū)動(dòng)板共地否則編碼器信號(hào)和電流采樣會(huì)異常。電源輸入端加上大電容避免電機(jī)啟停造成母線電壓跌落。9.2 軟件層面的建議第一次燒錄時(shí)把所有限制都調(diào)到最小低電壓、低電流、低速度。開環(huán)階段先不接入電流傳感器減少變量。閉環(huán)調(diào)試從電流環(huán)開始電流環(huán)穩(wěn)定后再調(diào)速度環(huán)最后才是位置環(huán)。每次修改參數(shù)后記錄修改內(nèi)容不要靠記憶。9.3 學(xué)習(xí)路線的建議如果你完全從零開始建議按下面的順序推進(jìn)先跑通開環(huán)轉(zhuǎn)動(dòng)確認(rèn)硬件鏈路。用串口讀取編碼器角度理解機(jī)械角度和電角度的關(guān)系。完成編碼器方向與零點(diǎn)校準(zhǔn)。接通電流采樣調(diào)通電流環(huán)。在電流環(huán)基礎(chǔ)上加速度環(huán)。最后加位置環(huán)完成三環(huán)串聯(lián)。有精力再研究無感 FOC 或更高性能的控制算法。關(guān)注以下幾個(gè)高頻搜索詞對(duì)深入理解 FOC 很有幫助FOC 電流采樣為什么設(shè)置在下橋、FOC 三環(huán)頻率、FOC 電流環(huán)、FOC 控制調(diào)試、PMSM 無感 FOC 控制、FOC 算法詳解、電機(jī) FOC 控制原理、FOC 驅(qū)動(dòng)速度環(huán)設(shè)計(jì)。這些關(guān)鍵詞分別對(duì)應(yīng) FOC 中“采樣時(shí)機(jī)”“控制帶寬”“坐標(biāo)變換”“觀測(cè)器設(shè)計(jì)”等不同知識(shí)點(diǎn)。建議每做完一個(gè)實(shí)驗(yàn)就搜一個(gè)對(duì)應(yīng)的關(guān)鍵詞來看效果比連續(xù)刷三天視頻好很多。另外還有幾個(gè)容易被忽視但非常重要的知識(shí)點(diǎn)FOC 的 Iq 是怎么產(chǎn)生磁場(chǎng)的、FOC 電調(diào)是否開啟同步整流、SVPWM 中直流母線電壓利用率的計(jì)算、不同負(fù)載條件下電流采樣窗口如何保證。這些問題雖然看起來偏理論但實(shí)際調(diào)參會(huì)直接遇到。10. 總結(jié)與下一步FOC 入門最值得先做的兩件事一是用開環(huán)控制把電機(jī)轉(zhuǎn)起來二是把編碼器角度反饋調(diào)準(zhǔn)。這兩步做完你的軟硬件鏈路已經(jīng)成立后面的電流環(huán)、速度環(huán)、位置環(huán)都是在這個(gè)基礎(chǔ)上加控制層而已。最容易踩的坑無非是三相線接錯(cuò)、編碼器方向搞反、零點(diǎn)偏了這幾種。這些問題排查方法上面都給了你只需要在出問題時(shí)冷靜地一次改一個(gè)變量。接下來值得你繼續(xù)往前走的幾個(gè)方向在現(xiàn)有硬件上完成電流環(huán)閉環(huán)觀察 Iq 和 Id 的波形體會(huì) Park 變換帶來的“直流化”效果。把速度環(huán)加上對(duì)比開環(huán)和閉環(huán)的轉(zhuǎn)速穩(wěn)定性差異。研究 SVPWM 的實(shí)現(xiàn)理解空間電壓矢量與三相占空比的關(guān)系。嘗試無感 FOC把編碼器換成反電動(dòng)勢(shì)觀測(cè)器。用 Simulink 或 Python 搭一套 FOC 仿真模型把算法在離線環(huán)境里跑透再回到硬件驗(yàn)證。建議先把這套流程跑通兩遍第一遍照著做第二遍把每個(gè)函數(shù)背后的原理查一遍。真正吃透 FOC并不需要你把所有公式推導(dǎo)得多么熟練而是要在調(diào)試中建立“現(xiàn)象-參數(shù)-算法”的對(duì)應(yīng)關(guān)系。電機(jī)轉(zhuǎn)不轉(zhuǎn)、穩(wěn)不穩(wěn)、響不響應(yīng)都能讓你快速定位是哪一環(huán)出了問題這才是入門到進(jìn)階的關(guān)鍵能力。