dsp2812實(shí)現(xiàn)三相異步電動(dòng)機(jī)FOC控制方案

1、II實(shí)現(xiàn)三相異步電動(dòng)機(jī)控制方案實(shí)驗(yàn)概述：本實(shí)驗(yàn)分步測(cè)試逐步完成從開(kāi)環(huán)控制到轉(zhuǎn)速、電流雙閉環(huán)控制，每步編譯用到的模塊不同。下面給出本程序中所有模塊及對(duì)應(yīng)步驟所編譯到的模塊。表2-1軟件模塊步驟1步驟2步驟3步驟4步驟5ENDRIVEVVVVVPWMDACVVVVVRAMPGENVVVVRAMPCNTLVVVVIPARKVVVVVVSVGENDQVVVVVVPWMDRVVVVVVVILEG2DCBUSDRVVVVVVPHASEVOLTAGECALCVVVVVCLARKEVVVVVPARKVVVVVCAPEVENTDRVVVVVVSPEEDPRVVVVVPIDREG3(ID)VVVVPIDREG3(

2、IQ)VVVVCURMODVVVPIDREG3(SPEED)VV圖標(biāo)J表示本步驟用到此模塊，圖標(biāo)表示本步驟要測(cè)試的模塊下面再給出每個(gè)模塊的輸入與輸出量名稱及其量值格式表2-2軟件模塊輸入量輸出量名稱格式名稱格式EN_DRIVEEnableFlagQ0GPIOA6GPIOA11GPIO寄存器PWMDAC_DRVPWMDACINPOINTER0PWMDACINPOINTER1PWMDACINPOINTER2PointerstoQ15variablesCMPR4CMPR5CMPR6T3PEREVB寄存器RAMP_GENFreqOffsetIQOutIQGainRAMP_CNTLTargetValue

3、IQSetpointValueIQI_PARKDsQsAngelIQAlphaBetaIQSVGEN_DQUalphaUbetaIQTaTbTcIQPWM_DRVMfuncClMfuncC2MfuncC3MfuncPeriodQ15CMPR1CMPR2CMPR3T1PEREVregistersILEG2_DCBUS_DRVADCINx/y/zADCH/WpinsImeasAImeasBImeasCVdcMeasQ15PHASE_VOLTAGE_CALCMfuncC1MfuncC2MfuncC3DcBusVoltIQVphaseAVphaseBVphaseCValphaVbetaIQCLARKE

4、AsBsIQAlphaBetaIQPARKAlphaBetaAngleIQDsQsIQCAPEVENTDRVCAPnEVH/WpinFIFOnEv寄存器SPEED_FRTimeStampEventPeriodInputSelectIQOutIQPID_REG3RefFdbIQOutIQCUR_MODIdsIqsWrIQThetaIQ（一）、FOC控制原理簡(jiǎn)介FOC即磁場(chǎng)定向控制，它的基本思路是利用d-q旋轉(zhuǎn)坐標(biāo)變換，將定子電流分解成勵(lì)磁電流Ds和轉(zhuǎn)矩電流Qs。在調(diào)速的過(guò)程中保持轉(zhuǎn)子磁鏈中2不變，即讓Ds=常數(shù)，此時(shí)，交流電動(dòng)機(jī)的調(diào)速原理與直流電動(dòng)機(jī)相同，控制定子電流的轉(zhuǎn)矩分量Qs就象控制直流電

5、動(dòng)機(jī)的電樞電流，可以線性的調(diào)節(jié)交流電動(dòng)機(jī)的輸出轉(zhuǎn)矩。（二）、系統(tǒng)組成方案及功能模塊劃分系統(tǒng)包含15個(gè)軟件模塊，下圖給出了步驟5中系統(tǒng)的功能模塊劃分和模塊間的相互關(guān)系。&HJIXL祀*4ADH趴工ADJNh臨4*妙皿CLJLghliHjmAILEtlJKB【足躋ETUQ38J：L7ET5KOTTOPAIKHDElEGJFCDJtffG圖2-1renm曲1EVLL口aDCHTFCAPDEVC.LT.Xai-囲1匕GEKPAA/I-bVfTiiiiirCs-+:n-?!AL-TnP-UiK團(tuán)haih-沖嚴(yán)CLARK嚴(yán)亠IVI1_SJLXI咋I二曲:心.JTChCATEVTSTDEVC.WmvawQI

6、圖2-2-1“步驟二”功能框圖INT2中斷T1UF_ISR保存現(xiàn)場(chǎng)并清除中斷標(biāo)志執(zhí)行RMP模塊執(zhí)行RMPGEN模塊執(zhí)行ILEG2VDC模塊執(zhí)行CLARKE/PARK變換執(zhí)行IPARK模塊圖2-2-2“步驟二”軟件流程在實(shí)時(shí)模式下打開(kāi)watchwindow窗口的Build2標(biāo)簽改變SpeedRef輸入?yún)⒘康闹?，從而改變斜坡信?hào)和正弦波的頻率。在主電路電源打開(kāi)的情況下、電機(jī)空載轉(zhuǎn)速在SpeedRef=0.99時(shí)可達(dá)到1450轉(zhuǎn)/分。在實(shí)時(shí)模式下修改watchwindow窗口中的VdTesting、VqTesting值，可以改變輸出正弦波的幅值。對(duì)應(yīng)VdTesting等效直流電機(jī)中的勵(lì)磁給定，此步中

7、為定值0.25。沒(méi)有特殊情況可不改變此值。VqTesting直流電機(jī)中的轉(zhuǎn)矩給定，空載時(shí)給0，當(dāng)電機(jī)帶負(fù)載后可適當(dāng)增加。注意VqTesting、VdTesting越大電機(jī)電流越大?？捎^察圖形顯示窗口中的Channal3&4中Ia和Ib電流的幅值，當(dāng)其正弦波電流畸變?yōu)榉钦視r(shí)說(shuō)明VqTesting、VdTesting給定已經(jīng)超出允許范圍，應(yīng)立即停止電機(jī)！在實(shí)驗(yàn)過(guò)程中不要長(zhǎng)時(shí)間給定很大值使電機(jī)工作。首先，根據(jù)操作規(guī)范，對(duì)照附錄二中的硬件連接圖連接實(shí)驗(yàn)系統(tǒng)硬件，接通控制電源。啟動(dòng)CCS軟件，用“Fileworkspace菜單命令打開(kāi)“ACI3_3_281XcIQmathbuild文件夾下的works

8、pace文件“aci3_3_281x_ccs2x.wks文件；將頭文件“build.h”中的編譯指令BUILDLEVEL設(shè)為“LEVEL2”；用“ProjectBuild”菜單命令編譯連接程序；編譯完成后，加載并在實(shí)時(shí)模式下運(yùn)行（RUN）“aci3_3.out”程序；接通主電路電源；選中WatchwindowBuild2標(biāo)簽將圖形顯示窗口Channal1&2、Channal3&4、watchwindow改為連續(xù)刷新。設(shè)置EnableFlag值為1。啟動(dòng)程序。改變SpeedRef、VdTesting、VqTesting值，觀測(cè)圖形顯示窗口波形變化。此時(shí)如果逆變電路正確，則電機(jī)緩慢啟動(dòng)，并逐漸達(dá)到

9、給定轉(zhuǎn)速；在實(shí)時(shí)模式下修改SpeedRef的值（00.99），相應(yīng)電動(dòng)機(jī)的轉(zhuǎn)速發(fā)生變化。為下一步實(shí)驗(yàn)測(cè)量Id的PID限幅值：測(cè)量Id的PID限幅值：SpeedRef=0.5使VqTesting=0,增加VdTesting直到圖形顯示中Ta的幅值為1，此時(shí)的VdTesting值即為下一步中IdPID的即幅值（0.6）。注意：同步驟一一樣VdTesting、VqTesting不要給太大值使電機(jī)長(zhǎng)時(shí)間工作。觀測(cè)Ta、RMPGENoutput、Ia、Ib的波形。圖2-2-3Ta和RMPGENoutput圖2-2-4Ia和lb步驟3、兩個(gè)電流PI調(diào)解器測(cè)試在步驟2的基礎(chǔ)上增加對(duì)DQ軸電流調(diào)節(jié)模塊功能的測(cè)

10、試和轉(zhuǎn)速測(cè)量。進(jìn)行本試驗(yàn)前要首先完成以上兩步實(shí)驗(yàn)，將電流反饋信號(hào)整定好。圖2-3-1給出了實(shí)驗(yàn)程序功能框圖，圖2-3-2給出了實(shí)驗(yàn)程序的軟件流程。以下給出步驟3中的控制參數(shù)及其調(diào)節(jié)范圍EnableFlag：0、1；啟停控制位SpeedRef：（00.99）；速度給定值IdRef：（00.6）；D軸電流給定IqRef：（00.6）；Q軸電流給定圖2-3-2“步驟3”軟件流程此步除調(diào)整以上參數(shù)以外可以在主程序aci3_3.c中找到初始化Id的PID_REG3和Iq的PID_REG3，改變其比例、積分、微分參數(shù)。使電機(jī)獲得更加好的的啟動(dòng)過(guò)程。首先，根據(jù)操作規(guī)范，對(duì)照附錄二中的硬件連接圖連接實(shí)驗(yàn)系統(tǒng)硬

11、件，接通控制電源。啟動(dòng)CCS軟件，用“Fileworkspace菜單命令打開(kāi)“ACI3_3_281XcIQmathbuild文件夾下的workspace文件“aci3_3_281x_ccs2x.wks文件；將頭文件“build.h”中的編譯指令BUILDLEVEL設(shè)為“LEVEL3”；用“ProjectBuild”菜單命令編譯連接程序；編譯完成后，加載并在實(shí)時(shí)模式下運(yùn)行（RUN）“aci3_3.out”程序；接通主電路電源；選中WatchwindowBuild3標(biāo)簽，將圖形顯示窗口Channal1&2、Channal3&4、watchwindow改為連續(xù)刷新。設(shè)置EnableFlag值為1，啟

12、動(dòng)程序。改變SpeedRef、IdRef、IqRef值，觀測(cè)圖形顯示窗口波形變化。此時(shí)如果參數(shù)給定正確，則電機(jī)緩慢啟動(dòng)，并逐漸達(dá)到給定轉(zhuǎn)速；在實(shí)時(shí)模式下修改SpeedRef的值（00.99）,相應(yīng)電動(dòng)機(jī)的轉(zhuǎn)速發(fā)生變化。觀測(cè)Ta和RMPGENoutput、Ia和轉(zhuǎn)速如圖所示：注意：同步驟樣IdRef、IqRef不要給太大值使電機(jī)長(zhǎng)時(shí)間工作。第一章三相民步電動(dòng)機(jī)FOC控制方案第一章三相民步電動(dòng)機(jī)FOC控制方案PttMlpmpmifiDs*BenlDtrtfADC:Nx(ji),W；INk陸專(zhuān)迥牲，呼in飾$電:酣CAFEVEWDRVCAPmvERV.QQ第一章三相民步電動(dòng)機(jī)FOC控制方案圖2-3-

13、1“步驟3”功能框圖第一章三相民步電動(dòng)機(jī)FOC控制方案第一章三相民步電動(dòng)機(jī)FOC控制方案步驟4、電流模型測(cè)試在步驟3的基礎(chǔ)上增加對(duì)電流模型模塊功能的測(cè)試。電流模型模塊從“PARK變換”模塊和速度測(cè)量模塊獲取輸入值，將計(jì)算得到的輸出值送給“CUR_MOD模塊”。此實(shí)驗(yàn)前需要整定電流反饋信號(hào)。圖2-4-1給出了實(shí)驗(yàn)程序的軟件流程，圖2-4-2給出了實(shí)驗(yàn)程序功能框圖。以下給出步驟4中的控制參數(shù)及其調(diào)節(jié)范圍EnableFlag：0、1；啟?？刂莆籗peedRef：（00.99）；速度給定值IdRef：（00.6）；D軸電流給定IqRef：（00.6）；Q軸電流給定qepl.CalibratedAngl

14、e：（0 x00000 xFFFF）；光電編碼器角度對(duì)位圖2-4-1“步驟4”軟件流程此步驟與上一步操作上是一樣的，只是增加了對(duì)CUR_MOD模塊的觀測(cè)，實(shí)驗(yàn)中觀測(cè)CUR_MOD模塊的輸出Theta的方向要與RMPGEN輸出output相同。若相反,將電機(jī)組中的光電編碼器連接到電動(dòng)機(jī)的另一端，從而改變光電編碼器采得的旋轉(zhuǎn)方向。首先，根據(jù)操作規(guī)范，對(duì)照附錄二中的硬件連接圖連接實(shí)驗(yàn)系統(tǒng)硬件，接通控制電源。啟動(dòng)CCS軟件，用“Fileworkspace菜單命令打開(kāi)“ACI3_3_281XcIQmathbuild文件夾下的workspace文件“aci3_3_281x_ccs2x.wks文件；將頭文件

15、“build.h”中的編譯指令BUILDLEVEL設(shè)為“LEVEL4”；用“ProjectBuild”菜單命令編譯連接程序；編譯完成后，加載并在實(shí)時(shí)模式下運(yùn)行（RUN）“aci3_3.out”程序;接通主電路電源；Watchwindow選中Build4標(biāo)簽，將圖形顯示窗口Channell&2、Channel3&4、watchwindow改為連續(xù)刷新。設(shè)置EnableFlag值為1。啟動(dòng)程序。改變SpeedRef、IdRef、IqRef值，光電編器角度對(duì)位：使SpeedRef=0.5,轉(zhuǎn)速穩(wěn)定在一個(gè)值。在watchwindow窗口Build4中空行處寫(xiě)入qep1.CalibratedAngle變

16、量，并改變其值大小，觀察Channel3&4中電流模型輸出和RMPGENoutput，使兩個(gè)鋸齒波的下降沿對(duì)齊（電流模型輸出略滯后于RMPGENoutput），記住此時(shí)的qep1.CalibratedAngle值，停止程序，去掉實(shí)時(shí)模式，RESETCPU,在程序aci3_3.c文件中找到初始化qep1.CalibratedAngle=x；的語(yǔ)句，將值寫(xiě)入等號(hào)后，重新編譯、載入程序，運(yùn)行程序驗(yàn)證角度對(duì)位是否正確。觀測(cè)圖形顯示窗口波形變化如下圖2-4-3、圖2-4-440.2310-Jnlxjc.sa.0.0JS40.0512D5.D128-0.G25S0.Q3B4-冏砸麗圖？4-4電流模型out

17、put；和RMPGENoutputiiTR益田1&3-0.231i0&.Q12SG.02S50r0.0135719：圖命3Ta和Ja-第一章三相民步電動(dòng)機(jī)FOC控制方案圖2-4-2“步驟 ”功能框圖第一章三相民步電動(dòng)機(jī)FOC控制方案第一章三相民步電動(dòng)機(jī)FOC控制方案圖2-4-2“步驟 ”功能框圖第一章三相民步電動(dòng)機(jī)FOC控制方案PiVMl卜EVEN!DRVffl!Q3F-FUGADDN咖41ADCNK.IbADCZNq隔第一章三相民步電動(dòng)機(jī)FOC控制方案第一章三相民步電動(dòng)機(jī)FOC控制方案步驟5、有傳感器速度閉環(huán)IFOC系統(tǒng)此步驟用于測(cè)試速度調(diào)節(jié)器功能是否正確，完整電流、速度閉環(huán)控制能否可靠實(shí)現(xiàn)

18、。此步驟需要全部系統(tǒng)模塊參與，它的正確實(shí)施要依靠前面5個(gè)步驟地正確進(jìn)行。實(shí)驗(yàn)前要首先進(jìn)行電流反饋信號(hào)的整定。速度調(diào)節(jié)模塊從速度測(cè)量模塊獲取速度反饋值，速度參考值由用戶給出，模塊的輸出作為轉(zhuǎn)矩參考送給電流調(diào)節(jié)器模塊。勵(lì)磁參考值由用戶設(shè)定。圖2-5-1給出了實(shí)驗(yàn)程序的軟件流程，圖2-5-2給出了實(shí)驗(yàn)程序功能框圖。以下給出步驟5中的控制參數(shù)及其調(diào)節(jié)范圍EnableFlag：0、1；啟?？刂莆籗peedRef：（00.99）；速度給定值IdRef：（00.3）；D軸電流給定c_int0INT2中斷初始化S/W模塊初始化寄存器T1T1UFISR保存現(xiàn)場(chǎng)并清除中斷標(biāo)志使能T1下益中斷和INT2中斷執(zhí)行ILEG2VDC模塊執(zhí)行CLARKE/PARK變換初始化其它系統(tǒng)和模塊參數(shù)（空循環(huán)INT2）執(zhí)行Spd/IQ/IDPID控制器|執(zhí)行IPARK模塊執(zhí)行SVGENDQ模塊第一章三相民步電動(dòng)機(jī)FOC控制方案第一章三相民步電動(dòng)機(jī)FOC控制方案第一章三相民步電動(dòng)機(jī)FOC控制方案第一章三相民步電動(dòng)機(jī)FOC控制方案圖2-5-1“步驟5”軟件流程第一章三相民步電動(dòng)機(jī)FOC控制方案圖2-5-2“步驟 ”功能框圖第一章三相民步電動(dòng)機(jī)FOC控制方案第一章三相民步電動(dòng)機(jī)FOC控制方案圖2-5-2“步驟 ”功能框圖第一章三相民步電動(dòng)機(jī)FOC控制方案Ajpta?AR