《三相交流异步电动机SVPWM开环调速控制程序》

1、三相交流异步电动机 .INCLUDE "240X.H" ;频率调节比,Q15格式（值为0-1,对应;频率调节比-角频率转换率，Q5格式 ,Q5格式SVPWM 开环调速控制程序（软件法）寄存器地址下定b5E2RGbCAP.BSS TEMP,1 ;临时变量.BSS SET_F,10-50Hz）p1EanqFDPw.BSS F_OMEGA,1.BSS OMEGA,1 ; 调制波角频率 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 表结束地址 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 ;-扇区数转换系数，Q15格式 BSS SECTOR,1 ;参考电压所在的扇区数 ，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 段 , 定 义 保 护 现 场 数 据 区 DXDiTa9E3dST0_SAVE .USECT ".CONTEXT"；状态寄存器ST0保存单元 ST1_SAVE .USECT ".CONTEXT"状态寄存器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 ，复位，优先级 1INT1BPHANTOM;地址0002H , INT1，优先级4INT2B_C_INT2;地址0004H , INT2，优先级5INT3BPHANTOM;地址 0006H， INT3 ，优先级 6INT4BPHANTOM地址0008H , INT4，优先级7INT5BPHANTOM;地址 000AH ， INT5 ，优先级 8INT6BPHANTOM;地址 000CH， INT6 ，优先级 9RESERVEDBPHANTOM;地址OOOEH，测试，优先级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 ，优先级 3EMU_TRAP BPHANTOM;地址0026H ，仿真Trap,优先级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; 系 统 初 始 化 xHAQX74J0X_C_INT0SETC INTM; 禁止中断CLRC CNF ;B0 为数据存储区LDP #224SPLK #0000001000000100B,SCSR1 ;CLKIN 10M,CLKOUT 20MSPLK #68H,WDCR; 不用看门狗LDP#225LACC MCRAOR#0FC0H;设置 PWM1-6 引脚SACL MCRA; 中 断 初 始 化 Zzz6ZB2LtkLDP #0SPLK #0FFH,IFR ; 清所有系统中断标志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; 死区时间 1*32*50ns=1.6usSPLK #1000001000000000B,COMC0NA;允许比较，不用硬件空间矢量SPLK #0000100001000010B,T1C0N;连续增减计数方式，预分频=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;频率调节比-角频率转换率，Q5格式;当SET_F=1时，对应最大角频率 2 n 50Hz*25=10053SPLK #0,THETA_L;低字,Q12格式SPLK #0,THETA_H ; 高字,Q12格式LAR AR0,#THETA_90 ;传送常用角度和逆阵数据LAR AR1,#(28-1); 28 个LACC #ANGLES_ ; 指向源LARP AR0INIT_TB

18、LTBLR *+,AR1 ;下一个ADD#1;下一个地址BANZ INIT_TBL,AR0 ;AR1=0 结束SPLK #29335,THETA_I ;相角查表索引，180/ n ,QMSPLK #31291,THETA_S ;-扇区数转换系数,6/(2 n ),Q格式SPLK #SIN_ENTRY_,SIN_ENTRY;SIN 表起始地址SPLK #(SIN_ENTRY_+90),SIN_END ;SIN 表结束地址; 主 循 环 程 序 (SET_F 由 外 部 输入) 6ewMyirQFLMAIN_LOOPLDP #6LT SET_F ;将频率调节比（Q15格式）转换成角频率MPY F_

19、OMEGA; Q15*Q5PACSACH 0MEGA,1 ;保存角频率,Q5格式LACC OMEGALT SET_FMPY MAX_VPACSACH SET_V ,1B MAIN_L00P ;；将频率调节比（Q15格式）转换成参考电压；保存参考电压幅值,Q14格式; Q15*Q14J假中 kavU42VRUs断处理PHANT0MCLRCJINTMRETT1下溢中断处理子程序循环 y6v3ALoS89_C_INT2SST #ST0,ST0_SAVE ； 保存现场 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;否则恢复现场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 ; 计算转角增量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如果在范围内恢复 THETA_H恢复 THETA_HRND_THETAADD #1,15 ; 圆整并保留高字SACH THETA_R;保存LACC#1 ; 假设 THETA_H 在第一象限SACL SS ; SIN 符号 =1SACL SC ; COS 符号 =1LACC THETA_RSACL THETA_M ;存入 THE

23、TA_M SUB THETA_90 ;BCND E_Q,LEQ;在第一象限则跳转SPLK #-1,SC ; COS 符号=1LACCTHETA_180SUB THETA_R ; 180- 0SACL THETA_M;存入 THETA_MBCNDE_Q,GEQ;在第二象限则跳转SPLK #-1,SS ;SIN 符号=-1LACC THETA_RSUB THETA_180 ;THETA-180SACL THETA_M ; 存入 THETA_MLACC THETA_270SUBTHETA_RBCNDE_Q,GEQ ;在第三象限则跳转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格式,即整数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 格式 .确定扇区MPY THETA_S ; Q12*Q15PACSACH SECTORLACC SECTOR,5SACH SECTOR ;相当于右移11位变成Q0格式（整

26、数）LACC#DEC_MS;逆阵数据首地址ADDSECTOR,2CMP1BIG0SACL TEMP ; 产生地址指针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继续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继续LACC #0;否则 0CMP2BIG0; T1 周期值; 如果大于 0继续 ; 否则 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; 数 据 M2ub6vSTnPANGLES_ .WORD 01922H ; n 12, Q1格式.WORD 03244H ; n , Q格式.WORD 04B66H ; 3 n /2, Q格式.WORD 06488H ; 2 n , Q格式.WORD 20066 ;矩阵A的逆阵数据，每一个逆阵有4个数据,Q14格式.WORD -1585;按参考电压所在的扇区索引.WORD 0.WORD 23170.WORD -20066.WORD 11585.WORD 20066.WORD 11585.WORD 0.WORD 23170.WORD