《三相交流異步電動機SVPWM開環(huán)調(diào)速控制程序》

1、三相交流異步電動機 .INCLUDE "240X.H" ;頻率調(diào)節(jié)比,Q15格式（值為0-1,對應(yīng);頻率調(diào)節(jié)比-角頻率轉(zhuǎn)換率，Q5格式 ,Q5格式SVPWM 開環(huán)調(diào)速控制程序（軟件法）寄存器地址下定b5E2RGbCAP.BSS TEMP,1 ;臨時變量.BSS SET_F,10-50Hz）p1EanqFDPw.BSS F_OMEGA,1.BSS OMEGA,1 ; 調(diào)制波角頻率 BSS SET_V,1 ;參考電壓,Q14格式 BSS T_SAMPLE,1 ;采樣周期,Q24格式 BSS THETA_H,1 ;參考電壓相位角高字，Q12格式 BSS THETA_L,1 ;參考

2、電壓相位角低字,Q12格式 BSS THETA_R,1 ;相位角的圓整值，Q12格式 BSS THETA_M,1 ;相位查表值（0-90度）,Q12格式 BSS THETA_I,1 ;相角查表索引，Q9格式 BSS SS,1 ;SIN符號,Q0格式 BSS SC,1 ;COS符號,Q0格式 BSS SIN_INDX,1 ;SIN 表索引，Q0格式 BSS SIN_ENTRY ,1 ;SIN表入口地址BSS SIN_END,1 ;SIN 表結(jié)束地址 BSS SIN_THETA,1 ;SIN 值,Q14 格式 BSS COS_THETA,1 ;COS 值,Q14格式 BSS UA,1 ;參考電壓D

3、軸分量UA,Q13格式 BSS UB,1;參考電壓Q軸分量UB,Q13格式 BSS THETA_S,1 ;-扇區(qū)數(shù)轉(zhuǎn)換系數(shù)，Q15格式 BSS SECTOR,1 ;參考電壓所在的扇區(qū)數(shù) ，Q0格式 BSS THETA_90,1 ;90 度,Q12格式 BSS THETA_180,1 ;180 度,Q12格式 BSS THETA_270,1 ;270 度,Q12格式 BSS THETA_360,1 ;360 度,Q12格式 BSS DEC_MS,24 ;6 個逆陣,Q14格式 BSS T1_PERIODS,1 ;定時器1周期值,Q5格式 BSS CMP_1,1 ;第1基本矢量,Q0格式 BSS

4、CMP_2,1 ;第2基本矢量,Q0格式 BSS CMP_0,1 ;0基本矢量/2,Q0格式 BSS FIRST_TOG ,1;存放第一次比較匹配的比較器地址BSS SEC_TOG,1 ;存放第二次比較匹配的比較器地址; CONTEXT 段 , 定 義 保 護 現(xiàn) 場 數(shù) 據(jù) 區(qū) DXDiTa9E3dST0_SAVE .USECT ".CONTEXT"；狀態(tài)寄存器ST0保存單元 ST1_SAVE .USECT ".CONTEXT"狀態(tài)寄存器ST1保存單元 ACCH USECT "EXTCONT",1 ;ACC 高字保存單元ACCL U

5、SECT "EXTCONT",1 ;ACC 低字保存單元AR0_SA VE .USECT ".EXTCONT",1 ;AR0 保存單元P_HI .USECT ".EXTCONT",1 ;P 寄存器高字保存單元P_LO .USECT ".EXTCONT",1 ;P 寄存器低字保存單元;定義子向量段; 偏移地址 0000H; 偏移地址 0001HPVECTORS BPHANTOMB PHANTOMT_SAVE .USECT ".EXTCONT",1 ;T 保存單元.SECT".VECTOR

6、S"定義主向量段RESETB_C_INT0;地址 0000H ，復位，優(yōu)先級 1INT1BPHANTOM;地址0002H , INT1，優(yōu)先級4INT2B_C_INT2;地址0004H , INT2，優(yōu)先級5INT3BPHANTOM;地址 0006H， INT3 ，優(yōu)先級 6INT4BPHANTOM地址0008H , INT4，優(yōu)先級7INT5BPHANTOM;地址 000AH ， INT5 ，優(yōu)先級 8INT6BPHANTOM;地址 000CH， INT6 ，優(yōu)先級 9RESERVEDBPHANTOM;地址OOOEH，測試，優(yōu)先級10SW_INT8BPHANTOM;地址0010H，

7、自定義軟中斷SW_INT9BPHANTOM;地址 0012H ，自定義軟中斷; 定 義 RTCrpUDGiT主向SW_INT10 B PHANTOM;地址0014H，自定義軟中斷SW_INT11BPHANTOM;地址0016H ，自定義軟中斷SW_INT12BPHANTOM;地址0018H ，自定義軟中斷SW_INT13BPHANTOM;地址001AH ，自定義軟中斷SW_INT14BPHANTOM;地址001CH ，自定義軟中斷SW_INT15BPHANTOM;地址001EH ，自定義軟中斷SW_INT16BPHANTOM;地址0020H ，自定義軟中斷TRAPBPHANTOM;地址0022

8、H ，TRAP 矢量NMIBPHANTOM;地址0024H ，NMI ，優(yōu)先級 3EMU_TRAP BPHANTOM;地址0026H ，仿真Trap,優(yōu)先級2SW_INT20BPHANTOM;地址0028H ，自定義軟中斷SW_INT21BPHANTOM;地址002AH ，自定義軟中斷SW_INT22BPHANTOM;地址002CH ，自定義軟中斷SW_INT23BPHANTOM;地址002EH ，自定義軟中斷SW_INT24BPHANTOM;地址0030H ，自定義軟中斷SW_INT25BPHANTOM;地址0032H ，自定義軟中斷SW_INT26BPHANTOM;地址0034H ，自定義

9、軟中斷SW_INT27BPHANTOM;地址0036H ，自定義軟中斷SW_INT28BPHANTOM;地址0038H ，自定義軟中斷SW_INT29BPHANTOM;地址003AH ，自定義軟中斷SW_INT30BPHANTOM;地址003CH ，自定義軟中斷SW_INT31BPHANTOM;地址003EH ，自定義軟中斷定義5PCzVD7HxA子向量.SECT".PVECS"BPHANTOM; 偏移地址 0002HBPHANTOM; 偏移地址 0003HBPHANTOM; 偏移地址 0004HBPHANTOM; 偏移地址 0005HBPHANTOM; 偏移地址 0006

10、HBPHANTOM; 偏移地址 0007HBPHANTOM; 偏移地址 0008HBPHANTOM; 偏移地址 0009HBPHANTOM; 偏移地址 000AHBPHANTOM; 偏移地址 000BHBPHANTOM; 偏移地址 000CHBPHANTOM; 偏移地址 000DHBPHANTOM; 偏移地址 000EHBPHANTOM; 偏移地址 000FHBPHANTOM; 偏移地址 0010HBPHANTOM; 偏移地址 0011HBPHANTOM; 偏移地址 0012HBPHANTOM; 偏移地址 0013HBPHANTOM; 偏移地址 0014HBPHANTOM; 偏移地址 0015

11、HBPHANTOM; 偏移地址 0016HBPHANTOM; 偏移地址 0017HBPHANTOM; 偏移地址 0018HBPHANTOM; 偏移地址 0019HBPHANTOM; 偏移地址 001AHBPHANTOM; 偏移地址 001BHBPHANTOM; 偏移地址 001CHBPHANTOM; 偏移地址 001DHBPHANTOM; 偏移地址 001EHBPHANTOM; 偏移地址 001FHBPHANTOM; 偏移地址 0020HBPHANTOM; 偏移地址 0021HBPHANTOM; 偏移地址 0022HBPHANTOM; 偏移地址 0023HBPHANTOM; 偏移地址 0024

12、HBPHANTOM; 偏移地址 0025HBPHANTOM; 偏移地址 0026HBPHANTOM; 偏移地址 0027HBPHANTOM; 偏移地址 0028HBT1UF_ISR; 偏移地址 0029HBPHANTOM; 偏移地址 002AHBPHANTOM; 偏移地址 002BHBPHANTOM; 偏移地址 002CHBPHANTOM; 偏移地址 002DHBPHANTOM; 偏移地址 002EHBPHANTOM; 偏移地址 002FHBPHANTOM; 偏移地址 0030HBPHANTOM; 偏移地址 0031HBPHANTOM; 偏移地址 0032HBPHANTOM; 偏移地址 003

13、3HBPHANTOM; 偏移地址 0034HBPHANTOM; 偏移地址 0035HBPHANTOM; 偏移地址 0036HBPHANTOM; 偏移地址 0037HBPHANTOM; 偏移地址 0038HBPHANTOM; 偏移地址 0039HBPHANTOM; 偏移地址 003AHBPHANTOM; 偏移地址 003BHBPHANTOM; 偏移地址 003CHBPHANTOM; 偏移地址 003DHBPHANTOM; 偏移地址 003EHBPHANTOM; 偏移地址 003FHBPHANTOM; 偏移地址 0040HBPHANTOM; 偏移地址 0041H; 以 下 是 主 jLBHrnAI

14、Lg.TEXT; 系 統(tǒng) 初 始 化 xHAQX74J0X_C_INT0SETC INTM; 禁止中斷CLRC CNF ;B0 為數(shù)據(jù)存儲區(qū)LDP #224SPLK #0000001000000100B,SCSR1 ;CLKIN 10M,CLKOUT 20MSPLK #68H,WDCR; 不用看門狗LDP#225LACC MCRAOR#0FC0H;設(shè)置 PWM1-6 引腳SACL MCRA; 中 斷 初 始 化 Zzz6ZB2LtkLDP #0SPLK #0FFH,IFR ; 清所有系統(tǒng)中斷標志SPLK #00000010B,IMR ;開INT2 中斷LDP #232SPLK #OFFFH,E

15、VAIFRA ;清事件管理器A所有中斷標志SPLK #0FH,EV AIFRB程序程序LDAYtRyKfE程序SPLK #0FH,EV AIFRCSPLK #0200H,EV AIMRA ;開T1 下溢中斷SPLK #0,EVAIMRB ;屏蔽所有中斷SPLK #0,EVAIMRC ;屏蔽所有中斷； 初 始 化 事 件 管 理 器 A 程 序 dvzfvkwMIlSPLK #500,T1PR ; T1 周期值=50 us/50 ns/2=500SPLK #500,CMPR1;占空比初值 0%SPLK #500,CMPR2SPLK #500,CMPR3SPLK #0000011001100110

16、B,ACTRA;引腳 PWM1,3,5 高有效,2,4,6低有效rqyn14ZNXISPLK #01F4H,DBTCONA; 死區(qū)時間 1*32*50ns=1.6usSPLK #1000001000000000B,COMC0NA;允許比較，不用硬件空間矢量SPLK #0000100001000010B,T1C0N;連續(xù)增減計數(shù)方式，預分頻=1CLRC INTM;開總中斷; 變 量 初 始 化 程 序 EmxvxOtOcoLDP #6 ;指向 B1SPLK #0347H,T_SAMPLE ;采 樣周期=50us *224=839 秒=347H, Q24 格 式SixE2yXPq5SPLK #16

17、000,T1_PERI0DS;T1 周期值的 Q5格式,500*32SPLK #11585,MAX_V;最大參考電壓幅值12 ,Q14格式SPLK #0,SET_F ; SET F=0SPLK #10053,F_OMEGA;頻率調(diào)節(jié)比-角頻率轉(zhuǎn)換率，Q5格式;當SET_F=1時，對應(yīng)最大角頻率 2 n 50Hz*25=10053SPLK #0,THETA_L;低字,Q12格式SPLK #0,THETA_H ; 高字,Q12格式LAR AR0,#THETA_90 ;傳送常用角度和逆陣數(shù)據(jù)LAR AR1,#(28-1); 28 個LACC #ANGLES_ ; 指向源LARP AR0INIT_TB

18、LTBLR *+,AR1 ;下一個ADD#1;下一個地址BANZ INIT_TBL,AR0 ;AR1=0 結(jié)束SPLK #29335,THETA_I ;相角查表索引，180/ n ,QMSPLK #31291,THETA_S ;-扇區(qū)數(shù)轉(zhuǎn)換系數(shù),6/(2 n ),Q格式SPLK #SIN_ENTRY_,SIN_ENTRY;SIN 表起始地址SPLK #(SIN_ENTRY_+90),SIN_END ;SIN 表結(jié)束地址; 主 循 環(huán) 程 序 (SET_F 由 外 部 輸入) 6ewMyirQFLMAIN_LOOPLDP #6LT SET_F ;將頻率調(diào)節(jié)比（Q15格式）轉(zhuǎn)換成角頻率MPY F_

19、OMEGA; Q15*Q5PACSACH 0MEGA,1 ;保存角頻率,Q5格式LACC OMEGALT SET_FMPY MAX_VPACSACH SET_V ,1B MAIN_L00P ;；將頻率調(diào)節(jié)比（Q15格式）轉(zhuǎn)換成參考電壓；保存參考電壓幅值,Q14格式; Q15*Q14J假中 kavU42VRUs斷處理PHANT0MCLRCJINTMRETT1下溢中斷處理子程序循環(huán) y6v3ALoS89_C_INT2SST #ST0,ST0_SAVE ； 保存現(xiàn)場 ST0SST #ST1,ST1_SAVE ;保存 ST1LDP #5SACH ACCHSACL ACCL ； 保存 ACCSPH P_

20、HISPL P_L0 ； 保存 P MPY #1 ； P<=TSPL T_SAVE； 保存 TSAR AR0,AR0_SA VE ;保存 AR0LDP #224LACC PIVR ; 讀偏移地址SUB #029H ; T1 下溢中斷 ?CC T1UF_ISR,EQ ; 是下溢中斷跳 T1UF_ISR RESTLDP#5;否則恢復現(xiàn)場LAR AR0, AR0_SA VE ; 恢復 AR0LT P_L0 ; 恢復 PMPY#1LPH P_HILT T_SAVE ; 恢復 TLACC ACCH,16ADDS ACCL ; 恢復 ACCLDP #0 ; 指向 B2LST #ST1,ST1_SA

21、VE ;恢復 ST1LST #ST0,ST0_SA VE ; 恢復 ST0CLRC INTM; 開中斷RET; 返回T1UF_ISRLDP #232SPLK #0200H,EVIFRA ; 清中斷標志LDP #6 ; 計算轉(zhuǎn)角增量LT OMEGA ; Q5MPY T_SAMPLE ; Q5*Q24PAC;積存 ACC, Q13SFR ;右移一位成Q12格式ADD THETA_H,16ADDS THETA_LSACH THETA_H ; 保存SACL THETA_LBCND CHK_UPLIM,GEQ ; Q12;計算絕對位置如果大于 0檢查上限ADDTHETA_360,16;否則與 2 n匕較

22、,Q12SACH THETA_H ; 保存B RND_THETACHK_UPLIMSUBTHETA_360,16BCND REST_THETA,LEQ;SACH THETA_HB RND_THETAREST_THETAADD THETA_360,16;與2 n匕較,Q12如果在范圍內(nèi)恢復 THETA_H恢復 THETA_HRND_THETAADD #1,15 ; 圓整并保留高字SACH THETA_R;保存LACC#1 ; 假設(shè) THETA_H 在第一象限SACL SS ; SIN 符號 =1SACL SC ; COS 符號 =1LACC THETA_RSACL THETA_M ;存入 THE

23、TA_M SUB THETA_90 ;BCND E_Q,LEQ;在第一象限則跳轉(zhuǎn)SPLK #-1,SC ; COS 符號=1LACCTHETA_180SUB THETA_R ; 180- 0SACL THETA_M;存入 THETA_MBCNDE_Q,GEQ;在第二象限則跳轉(zhuǎn)SPLK #-1,SS ;SIN 符號=-1LACC THETA_RSUB THETA_180 ;THETA-180SACL THETA_M ; 存入 THETA_MLACC THETA_270SUBTHETA_RBCNDE_Q,GEQ ;在第三象限則跳轉(zhuǎn)SPLK #1,SC; COS 符號 =1LACC THETA_36

24、0SUB THETA_RSACL THETA_M ; 在第四象限E_QLT THETA_M ; Q12. 計算查表索引MPY THETA_I ; Q12*Q9PACSACH SIN_INDX ; Q5LACC SIN_INDX,11 ; 左移 11位SACH SINNDX ;相當于右移5位變成Q0格式,即整數(shù)LACC SIN_ENTRY ;查 SIN 表ADD SIN_INDXTBLR SIN_THETALACC SIN_ENDSUB SIN_INDX ;TBLR COS_THETA ;LTSS ;查 COS 表MPY SIN_THETA ; 修改符號 ,Q14PACSACLSIN_THETA

25、; 左移 16位保存 ,Q14LT SCMPY COS_THETA ; 修改符號 , Q14PACSACL COS_THETA ; 左移 16位保存 ,Q14LT SET_V ; 開始計算 UA , UBMPY COS_THETA ; Q14*Q14PACSACH UA,1 ; UA ,Q13 格式MPY SIN_THETA ; Q14*Q14PACSACH UB,1 ; UB, Q13 格式LT THETA_R ; Q12 格式 .確定扇區(qū)MPY THETA_S ; Q12*Q15PACSACH SECTORLACC SECTOR,5SACH SECTOR ;相當于右移11位變成Q0格式（整

26、數(shù)）LACC#DEC_MS;逆陣數(shù)據(jù)首地址ADDSECTOR,2CMP1BIG0SACL TEMP ; 產(chǎn)生地址指針LAR AR0,TEMP ; 指向逆陣表LT UA ; Q13 格式.計算 UA*M(1,1)+UB*M(1,2)MPY *+ ; M(1,1) UA, Q13*Q14PAC ； Q11 格式LT UB ; Q11MPY *+ ; M(1,2) UB, Q13*Q14APAC ; 0.5*C1, Q11+Q11BCND CMP1BIG0,GEQ; 如果大于 0繼續(xù)LACC #0; 否則 0SACH TEMP; 0.5*C1,Q11 格式LT TEMP ; Q11 格式MPY T1

27、_PERIODS ; Q11*Q5PAC ; Q0 格式SACH CMP_1 ; 0.5*C1*TP,Q0 格式LT UA ;計算 UA*M(2,1)+UB*M(2,2)MPY *+ ; M(2,1) UA,Q13*Q14PAC ; Q11 格式LT UB ; Q13 格式MPY *+ ; M(2,2) UB: Q13*Q14APAC ; 0.5*C2,Q11+Q11BCND CMP2BIG0,GEQ; 如果大于 0繼續(xù)LACC #0;否則 0CMP2BIG0; T1 周期值; 如果大于 0繼續(xù) ; 否則 0SACH TEMP ; 0.5*C2,Q11 格式LT TEMP; Q11 格式MPY

28、 T1_PERIODS ; Q11*Q5PAC ; Q0 格式SACH CMP_2 ; 0.5*C2*TP,Q0 格式LACC #500SUB CMP_1SUB CMP_2 ; Q0 格式BCNDCMP0BIG0,GEQLACC #0CMP0BIG0SACL CMP_0LACC CMP_0,15 ; 相當于右移 1位,除2SACH CMP_0 ; 0.25*C0*TPLACC #FIRST_;指向第一次比較匹配的比較寄存器地址表入口地址ADD SECTORTBLR FIRST_TOG; 查到第一次比較匹配的比較器地址LAR AR0,FIRST_TOG ; 指向該地址LACC CMP_0SACL

29、 * ; CMP_0 送入該比較器LACC #SECOND_ ; 指向第二次比較匹配的比較寄存器地址表入口地址 ADD SECTORTBLR SEC_TOG ; 查到第二次比較匹配的比較器地址LAR AR0,SEC_TOG ; 指向該地址LACC CMP_0ADD CMP_1 ; CMP_0+CMP_1SACL * ; 送入該比較器LACC #CMPR3SUB FIRST_TOGADD #CMPR2SUB SEC_TOGADD #CMPR1SACL TEMP ; 計算第三次比較匹配的比較器地址LAR AR0,TEMP ; 指向該地址LACC CMP_0ADDCMP_1ADD CMP_2 ; C

30、MP_0+CMP_1+CMP_2 SACL * ; 送入該比較器 B REST ; 返回 .DATA; 數(shù) 據(jù) M2ub6vSTnPANGLES_ .WORD 01922H ; n 12, Q1格式.WORD 03244H ; n , Q格式.WORD 04B66H ; 3 n /2, Q格式.WORD 06488H ; 2 n , Q格式.WORD 20066 ;矩陣A的逆陣數(shù)據(jù)，每一個逆陣有4個數(shù)據(jù),Q14格式.WORD -1585;按參考電壓所在的扇區(qū)索引.WORD 0.WORD 23170.WORD -20066.WORD 11585.WORD 20066.WORD 11585.WORD 0.WORD 23170.WORD