三相交流异步电动机矢量控制程序.doc

51三相交流异步电动机矢量控制程序 .include 240x.hKSPEED .set 3415 SPEEDSTEP30 .set 30 .bss T1_PERIODS,1 .bss KCURRENT,1 .bss KI,1 .bss KP,1 .bss KC,1 .bss KIN,1 .bss KPN,1 .bss KCN,1 .bss VMIN,1 .bss VMAX,1 .bss IMAX,1 .bss TMP,1 .bss IA,1 .bss IB,1 .bss IC,1 .bss SIN,1 .bss COS,1 .bss DEC_MS,24 .bss CMP_1,1 .bss CMP_2,1 .bss CMP_0,1 .bss FIRST_TOG,1 .bss SEC_TOG,1 .bss TETA_E,1 .bss TETA_E1,1 .bss IALFA,1 .bss IBETA,1 .bss VALF_REF,1 .bss VBET_REF,1 .bss IMREF,1 .bss ITREF,1 .bss IM,1 .bss IT,1 .bss VMREF,1 .bss VTREF,1 .bss EPIT,1 .bss EPIM,1 .bss XIT,1 .bss XIM,1 .bss N,1 .bss N_REF,1 .bss EPISPEED,1 .bss XISPEED,1 .bss P,1 .bss ITREFMIN,1 .bss ITREFMAX,1 .bss SECTOR,1 .bss INDEX,1 .bss UPI,1 .bss ELPI,1 .bss ENCODEROLD,1 .bss ENCINCR,1 .bss SPEEDTMP,1 .bss SPEEDSTEP,1 .bss KR,1 .bss KT,1 .bss K,1 .bss IDK,1 .bss FS,1 .bss TETAINCR,1 .bss TMP1,1 .TEXT CLRC CNF SETC OVM SPM 0 SETC SXM LAR AR0,#DEC_MS LAR AR1,#(24-1) LACC #ANGLES_ LARP AR0 INIT_TBL TBLR *+,AR1 ADD #1 BANZ INIT_TBL,AR0 LAR AR4,#79H LDP #0E0H SPLK #68H, WDCR SPLK #0284H,SCSR1 LDP #0E1H SPLK #0900H,ADCTRL1 SPLK #0001H,MAXCONV SPLK #0010H,CHSELSEQ1 LACC MCRA OR #0FD8H SACL MCRA LDP #0 SPLK #32000,T1_PERIODS SPLK #KI,KI SPLK #KP,KP SPLK #KC,KC SPLK #KIN,KIN SPLK #KPN,KPN SPLK #KCN,KCN SPLK #VMIN,VMIN SPLK #VMAX, VMAX SPLK #IMAX,IMAX SPLK #1383H,KCURRENT SPLK #39,KR SPLK #156,KT SPLK #328,K SPLK #0,IDK SPLK #0,FS SPLK #0,TETAINCR SPLK #0,TMP SPLK #0,TMP1 SPLK #0,TETA_E SPLK #0,TETA_E1 LACC IMAX SACL ITREFMAX NEG SACL ITREFMIN LACC #0 SACL ITREF SACL IMREF SACL N_REF SACL INDEX SACL XIM SACL XIT SACL XISPEED SACL UPI SACL ELPI SACL ENCODEROLD SACL N SACL SPEEDTMP LACC #SPEEDSTEP30 SACL SPEEDSTEP LDP #0E8H SPLK #0666H,ACTRA SPLK #1000,CMPR1 SPLK #1000,CMPR2 SPLK #1000,CMPR3 SPLK #01F4H,DBTCONA SPLK #8200H,COMCONA SPLK #1000,T1PR SPLK #0,T1CNT SPLK #0840H,T1CON SPLK #0,T2CNT SPLK #0FFFFH,T2PR SPLK #9870H,T2CON SPLK #0FFFH,EVAIFRA SPLK #000FH,EVAIFRB SPLK #000FH,EVAIFRC SPLK #0200H,EVAIMRA SPLK #0000H,EVAIMRB SPLK #0000H,EVAIMRC LDP #0H LACC #0FFH SACL IFR LACC #0000010B SACL IMR CLRC INTM _C_INT2 MAR *,AR4 MAR *- SST #1,*- SST #0,*- SACH *- SACL *- LDP #0E0H LACC PIVR LDP #0E8H SPLK #0200H,EVAIFRA LDP #0E1H SPLK #2000H,ADCTRL2 CONVERSION BIT ADCTRL2,3 BCND CONVERSION,TC LACC RESULT0,10 LDP #0 SACH IA LDP #0E1H LACC RESULT1,10 LDP #0 SACH IB LDP #0E8H LACC T2CNT ;NEG LDP #0 SACL TMP SUB ENCODEROLD SACL ENCINCR LACC TMP SACL ENCODEROLD LACC SPEEDSTEP SUB #1 SACL SPEEDSTEP BCND NOCALC,GT LT SPEEDTMP MPY #KSPEED PAC SFL SACH N,7 LACC #0 SACL SPEEDTMP LACC #SPEEDSTEP30 SACL SPEEDSTEP LACC N_REF SUB N SACL EPISPEED LACC XISPEED,12 LT EPISPEED MPY KPN APAC SACH UPI,4 BIT UPI,0 BCND UPIMAGZEROS,NTC LACC ITREFMIN SUB UPI BCND NEG_SAT,GT LACC UPI B LIMITERSNEG_SAT LACC ITREFMIN B LIMITERSUPIMAGZEROS LACC ITREFMAX SUB UPI BCND POS_SAT,LT LACC UPI B LIMITERSPOS_SAT LACC ITREFMAX LIMITERS SACL ITREF SUB UPI SACL ELPI LT ELPI MPY KCN PAC LT EPISPEED MPY KIN APAC ADD XISPEED,12 SACH XISPEED,4 NOCALC LACC SPEEDTMP ADD ENCINCR SACL SPEEDTMP LDP #0 LACC IA AND #3FFH SUB #512 SACL TMP LT TMP MPY KCURRENT PAC SFL SACH IA,7 LACC IB AND #3FFH SUB #512 SACL TMP LT TMP MPY KCURRENT PAC SFL SACH IB,7 LACC IB ADD IA NEG SACL IC LDP #0 LT IA MPY #5018 PAC SACH IALFA,4 LACC IB,1 ADD IA SACL TMP LT TMP MPY #2896 PAC SACH IBETA ,4 LACC TETA_E1 RPT #3 SFR AND #0FFH SACL INDEX ADD #SINTAB TBLR SIN LACL INDEX ADD #040H AND #0FFH ADD #SINTAB TBLR COS LACC #0 LT IBETA MPY SIN LTA IALFA MPY COS MPYA SIN SACH IM,4 LACC #0 LT IBETA MPYS COS APAC SACH IT,4 LACC IM SUB IDK SACL TMP LT TMP MPY KR PAC SACH TMP,1 LACC TMP ADD IDK SACL IDK BCND IDKNOTZERO,NEQ LACC #0 SACL TMP B ITPOSIDKNOTZERO SACL TMP1 LACC IT ABS SACL TMP LACC TMP,12 RPT #15 SUBC TMP1 SACL TMP LACC IT BCND ITPOS,GT LACC TMP NEG SACL TMPITPOS LT TMP MPY KT PAC SACH TMP,4 LACC TMP ADD N SFR SACL FS LACC FS ABS SACL TMP LT TMP MPY K PAC SACH TETAINCR,4 BIT FS,0 BCND FS_NEG,TC LACL TETAINCR ADDS TETA_E SACL TETA_E B FS_POSFS_NEG LACL TETA_E SUBS TETAINCR SACL TETA_EFS_POS LACC TETA_E,12 SACH TETA_E1 LACC ITREF SUB IT SACL EPIT LACC XIT,12 LT EPIT MPY KP APAC SACH UPI,4 BIT UPI,0 BCND UPIMAGZEROT,NTC LACC VMIN SUB UPI BCND NEG_SATT,GT LACC UPI B LIMITERTNEG_SATT LACC VMIN B LIMITERTUPIMAGZEROT LACC VMAX SUB UPI BCND POS_SATT,LT LACC UPI B LIMITERTPOS_SATT LACC VMAX LIMITERT SACL VTREF SUB UPI SACL ELPI LT ELPI MPY KC PAC LT EPIT MPY KI APAC ADD XIT,12 SACH XIT,4 LACC IMREF SUB IM SACL EPIM LACC XIM,12 LT EPIM MPY KP APAC SACH UPI,4 BIT UPI,0 BCND UPIMAGZEROM,NTC LACC VMIN SUB UPI BCND NEG_SATM,GT LACC UPI B LIMITERMNEG_SATM LACC VMIN B LIMITERMUPIMAGZEROM LACC VMAX SUB UPI BCND POS_SATM,LT LACC UPI B LIMITERMPOS_SATM LACC VMAX LIMITERM SACL VMREF SUB UPI SACL ELPI LT ELPI MPY KC PAC LT EPIM MPY KI APAC ADD XIM,12 SACH XIM,4 LACC #0 LT VMREF MPY SIN LTA VTREF MPY COS MPYA SIN SACH VBET_REF,4 LACC #0 LT VMREF MPYS COS APAC SACH VALF_REF,4 LACC #0 SACL P LACC VBET_REF BCND B0_NEG, LEQ LACC #1 SACL P B0_NEG LT VALF_REF MPY #7095 PAC SACH TMP,4 LACC TMP SUB VBET_REF SFR BCND B1_NEG,LEQ LACC P ADD #2 SACL P B1_NEG LACC TMP ADD VBET_REF SFR NEG BCND B2_NEG,LEQ LACC P ADD #4 SACL P B2_NEG LACC #PSECTOR ADD P SUB #1 TBLR SECTOR LACC #DEC_MS ADD SECTOR,2 SACL TMP LAR AR0,TMP LT VALF_REF MPY *+ PAC LT VBET_REF MPY *+ APAC BCND CMP1BIG0,GEQ LACC #0 CMP1BIG0 SACH TMP LT TMP MPY T1_PERIODS PAC SACH CMP_1,1 LT VALF_REF MPY *+ PAC LT VBET_REF MPY *+ APAC BCND CMP2BIG0,GEQ LACC #0 CMP2BIG0 SACH TMP LT TMP MPY T1_PERIODS PAC SACH CMP_2,1 LACC #1000 SUB CMP_1 SUB CMP_2 BCND CMP0BIG0,GEQ LACC #0 CMP0BIG0 SACL CMP_0 LACC CMP_0,15 SACH CMP_0 LACC #FIRST_ ADD SECTOR TBLR FIRST_TOG LAR AR0,FIRST_TOG LACC CMP_0 SACL * LACC #SECOND_ ADD SECTOR TBLR SEC_TOG LAR AR0,SEC_TOG LACC CMP_0 ADD CMP_1 SACL * LACC #CMPR3 SUB FIRST_TOG ADD #CMPR2 SUB SEC_TOG ADD #CMPR1 SACL TMP LAR AR0,TMP LACC CMP_0 ADD CMP_1 ADD CMP_2 SACL * LARP AR4 MAR *+ LACL *+ ADD *+,16 LST #0,*+ LST #1,*+ CLRC INTM RET .dataPSECTOR .word 1 .word 5 .word 0 .word 3 .word 2 .word 4SINTAB .word 0 .word 101,201,301,401,501 .word 601,700,799,897,995 .word 1092,1189,1285,1380,1474 .word 1567,1660,1751,1842,1931 .word 2019,2106,2191,2276,2359 .word 2440,2520,2598,2675,2751 .word 2824,2896,2967,3035,3102 .word 3166,3229,3290,3349,3406 .word 3461,3513,3564,3612,3659 .word 3703,3745,3784,3822,3857 .word 3889,3920,3948,3973,3996 .word 4017,4036,4052,4065,4076 .word 4085,4091,4095,4096,4095 .word 4091,4085,4076,4065,4052 .word 4036,4017,3996,3973,3948 .word 3920,3889,3857,3822,3784 .word 3745,3703,3659,3612,3564 .word 3513,3461,3406,3349,3290 .word 3229,3166,3102,3035,2967 .word 2896,2824,2751,2675,2598 .wor