FOC簡述

磁場(chǎng)定向控制（Field Oriented Control，F(xiàn)OC），是目前無刷直流電機(jī)（BLDC）和永磁同步電機(jī)（PMSM）控制領(lǐng)域所采用的一種數(shù)學(xué)變換方法。FOC 精確地控制磁場(chǎng)大小與方向，使得電機(jī)轉(zhuǎn)矩平穩(wěn)、噪聲小、效率高，并且具有高速的動(dòng)態(tài)響應(yīng)。

FOC 一般采用三環(huán)控制，分別為電流環(huán)、速度環(huán)、位置環(huán)。電流環(huán)控制電機(jī)的轉(zhuǎn)矩，是FOC 控制的根本。而速度環(huán)、位置環(huán)主要通過檢測(cè)的電機(jī)編碼器的信號(hào)來進(jìn)行負(fù)反饋PI調(diào)節(jié)，它的環(huán)內(nèi)PI輸出直接就是電流環(huán)的給定，所以速度環(huán)控制時(shí)就包含了速度環(huán)和電流環(huán)，換句話說任何模式都必須使用電流環(huán)，電流環(huán)是控制的根本，在速度和位置控制的同時(shí)系統(tǒng)實(shí)際也在進(jìn)行電流（轉(zhuǎn)矩）的控制以達(dá)到對(duì)速度和位置的相應(yīng)控制。

方案介紹

基于FOC Current Loop IP 的有感FOC 系統(tǒng)如下圖所示。整個(gè)系統(tǒng)包含MCU、FPGA、電機(jī)功率驅(qū)動(dòng)板（電機(jī)功率驅(qū)動(dòng)板包括一些基本的保護(hù)、檢測(cè)、控制信號(hào)，且驅(qū)動(dòng)電路應(yīng)符合SVPWM 調(diào)制原理）和帶位置傳感器接口的電機(jī)（譬如，絕對(duì)式/增量式等）。

基于FOC Current Loop IP 的有感FOC 實(shí)現(xiàn)

FPGA 部分主要實(shí)現(xiàn)FOC 電流環(huán)閉環(huán)系統(tǒng)，主要包含：

GW FOC Current Loop IP，提供電流環(huán)的核心計(jì)算；

電機(jī)編碼器解析模塊：用于獲取電機(jī)位置反饋值。

ADC 采樣模塊：用于采集UV 兩相電流反饋值。若采用SIGMA-DELTA ADC，則FPGA內(nèi)部需實(shí)現(xiàn)SINC3 濾波及轉(zhuǎn)換處理；若采用SAR 型ADC，一般采用SPI 接口解析。

相電流偏置補(bǔ)償模塊：用于補(bǔ)償驅(qū)動(dòng)板在零電流驅(qū)動(dòng)下的偏置值。

電角度轉(zhuǎn)換模塊：用于將獲得電機(jī)位置反饋值轉(zhuǎn)換為電角度。

轉(zhuǎn)子初始化模塊：上電時(shí)，轉(zhuǎn)子的初始位置是未知的，該模塊用于上電之后，校準(zhǔn)電機(jī)轉(zhuǎn)子與0 電角度對(duì)齊。

總線接口模塊：FPGA 與MCU 交互數(shù)據(jù)的模塊，推薦采用并行總線接口通信。

MCU 部分主要實(shí)現(xiàn)FOC 的速度/位置環(huán)，有：

速度環(huán)：從FPGA 側(cè)獲取位置反饋信息（電機(jī)機(jī)械角度）后，估算出當(dāng)前速度值（單位rpm），再根據(jù)想要獲得的速度參考值進(jìn)行速度pi 控制，并輸出轉(zhuǎn)矩值給FPGA 側(cè)的電流環(huán)，形成雙環(huán)閉環(huán)系統(tǒng)。

位置環(huán)：從FPGA 側(cè)獲取位置反饋信息（電機(jī)機(jī)械角度），根據(jù)位置指令與當(dāng)前位置反饋信息的偏差進(jìn)行位置PI 控制，并輸出參數(shù)給速度環(huán)，接著經(jīng)過速度環(huán)pi 控制輸出指令至FPGA 側(cè)的電流環(huán)，形成三環(huán)閉環(huán)系統(tǒng)。

應(yīng)用案例

該參考設(shè)計(jì)的硬件平臺(tái)采用DK_START_GW2A18-PG256 開發(fā)板（FPGA 型號(hào)為GW2A-18K），主要實(shí)現(xiàn)相電流采集、相電流補(bǔ)償、電機(jī)編碼器接口、FOC current Loop IP、轉(zhuǎn)子初始化及FSMC 接口功能，其中pwm 波的頻率為16KHz，電流環(huán)的更新頻率亦為16KHz。

基于STM32F407 的最小系統(tǒng)板，主要實(shí)現(xiàn)位置環(huán)和速度環(huán)，其中位置環(huán)和速度環(huán)的更新頻率為2KHz。

電機(jī)驅(qū)動(dòng)板，母線電壓為24V，采用6 單元MOSFET 結(jié)構(gòu)，板上含有帶SPI 接口的SAR 型ADC 芯片，分別對(duì)U/V 兩相上橋臂進(jìn)行電流采樣。

帶增量式/絕對(duì)式編碼器的PMSM 電機(jī)（demo 均支持），其中增強(qiáng)式編碼器采用4x模式，角度分辨率為一圈4000。而絕對(duì)式編碼器采用RS485 電平，角度分辨率為一圈2^23，在demo 中，只用了絕對(duì)式編碼器的高16bit，也就是說電機(jī)轉(zhuǎn)一圈計(jì)數(shù)值從0~65536。注，后續(xù)的分析默認(rèn)是基于絕對(duì)式編碼器。

stm32 與FPGA 采用異步FSMC的并行總線進(jìn)行交互數(shù)據(jù)，交互方式為中斷觸發(fā)。

GW FOC 應(yīng)用參考案例

編輯：jq