采用不对称规则采样法生成三相SPWM波的开环调速控制程序.doc

41采用不对称规则采样法生成三相SPWM波的开环调速控制程序 . .include 240x.h .global _c_int0 ST0 .set 0 ST1 .set 1 .bss TEMP,1 .bss TEMP1,1 .bss TEMP2,1 .bss TEMP3,1 .bss TEMP4,1 .bss TEMP5,1 .bss TEMP6,1 .bss K_,1 .bss PITC,1 .bss F2M,1 .bss T_QUA,1 .bss F_CARR,1 .bss PMIN,1 .bss PMAX,1 .bss F_MODU,1 .bss N_,1 .bss M_,1 .bss KMAX,1 .bss ATOD,1 .bss ACCH,1 .bss ACCL,1 .bss AR0_SAVE,1 .bss P_HI,1 .bss P_LO,1 ST0_SAVE .usect .context,1 ST1_SAVE .usect .context,1 .sect .vectors RESET B _c_int0 INT1 B PHANTOM INT2 B _C_INT2 INT3 B PHANTOM INT4 B PHANTOM INT5 B PHANTOM INT6 B PHANTOM RESERVED B PHANTOMSW_INT8 B PHANTOMSW_INT9 B PHANTOMSW_INT10 B PHANTOMSW_INT11 B PHANTOMSW_INT12 B PHANTOMSW_INT13 B PHANTOMSW_INT14 B PHANTOMSW_INT15 B PHANTOMSW_INT16 B PHANTOMTRAP B PHANTOMNMI B PHANTOMEMU_TRAP B PHANTOMSW_INT20 B PHANTOMSW_INT21 B PHANTOMSW_INT22 B PHANTOMSW_INT23 B PHANTOMSW_INT24 B PHANTOMSW_INT25 B PHANTOMSW_INT26 B PHANTOMSW_INT27 B PHANTOMSW_INT28 B PHANTOMSW_INT29 B PHANTOMSW_INT30 B PHANTOMSW_INT31 B PHANTOM.sect .pvecs PVECTORSBPHANTOM BPHANTOM BPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOM BPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOM BPHANTOMBPHANTOM BPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOM BPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOM BPHANTOM BPHANTOMBWXM BPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOM BPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOMBPHANTOM .text_c_int0 SETC INTM CLRC CNF LDP #224 SPLK #0000000000000100B,SCSR1 SPLK #68H,WDCR LDP #225 LACC MCRA OR #0FC0H SACL MCRA LDP #0 SPLK #0FFH,IFR SPLK #00000010B,IMR LDP #232 SPLK #0FFFH,EVAIFRA SPLK #0FH,EVAIFRB SPLK #0FH,EVAIFRC SPLK #0200H,EVAIMRA SPLK #0,EVAIMRB SPLK #0,EVAIMRC SPLK #1000,T1PR SPLK #1000,CMPR1 SPLK #1000,CMPR2 SPLK #1000,CMPR3 SPLK #0000011001100110B,ACTRA SPLK #01F4H,DBTCONA SPLK #1000001000000000B,COMCONA SPLK #0000100001000010B,T1CON CLRC INTM LDP #6 SPLK #0,K_ SPLK #42166,PITC SPLK #37749,F2M SPLK #250,T_QUA SPLK #40000,F_CARR SPLK #120,PMIN SPLK #1880,PMAX SPLK #917,ATOD SPLK #480,F_MODU CYCLE LDP #6 CLRC SXM LACC F_MODU,13 SACH TEMP LACC F_CARR RPT #15 SUBC TEMP SACL N_ LACC N_,1 SACL KMAX LT F2M MPYU F_MODU PAC SACH M_ B CYCLE PHANTOM RET _C_INT2 SST #ST0,ST0_SAVE SST #ST1,ST1_SAVE LDP #6 SACH ACCH SACL ACCL SPH P_HI SPL P_LO MPY #1 SPL T_SAVE LDP #224 LACC PIVR,1 ADD # PVECTORS BACC WXM LDP #232 SPLK #0FFFH,EVAIFRA LDP #6 LT PITC MPYU K_ PAC SACH TEMP1 LT TEMP1 MPYU F_MODU PAC RPT #3 ROR SACL TEMP1 LACC TEMP1 ADD #8579 SACL TEMP2 SUB #25736 BCND WXM1 ,LEQ SACL TEMP2 WXM1 LACC TEMP1 ADD #17157 SACL TEMP3 SUB #25736 BCND WXM2 ,LEQ SACL TEMP3 WXM2 LT TEMP1 MPYU ATOD PAC SACH TEMP1 LACC #SIN_ENTRY ADD TEMP1 TBLR TEMP1 LT TEMP1 MPY M_ PAC SACH TEMP1,7 LACC TEMP1 ADD #1,14 SACL TEMP1 LT T_QUA MPYU TEMP1 PAC SACH TEMP1,2 LT TEMP2 MPYU ATOD PAC SACH TEMP2 LACC #SIN_ENTRY ADD TEMP2 TBLR TEMP2 LT TEMP2 MPY M_ PAC SACH TEMP2,7 LACC TEMP2 ADD #1,14 SACL TEMP2 LT T_QUA MPYU TEMP2 PAC SACH TEMP2,2 LT TEMP3 MPYU ATOD PAC SACH TEMP3 LACC #SIN_ENTRY ADD TEMP3 TBLR TEMP3 LT TEMP3 MPY M_ PAC SACH TEMP3,7 LACC TEMP3 ADD #1,14 SACL TEMP3 LT T_QUA MPYU TEMP3 PAC SACH TEMP3,2 LACC K_ ADD #1 SACL K_ LT PITC MPYU K_ PAC SACH TEMP4 LT TEMP4 MPYU F_MODU PAC RPT #3 ROR SACL TEMP4 LACC TEMP4 ADD #8579 SACL TEMP5 SUB #25736 BCND WXM3 ,LEQ SACL TEMP5 WXM3 LACC TEMP4 ADD #17157 SACL TEMP6 SUB #25736 BCND WXM4 ,LEQ SACL TEMP6 WXM4 LT TEMP4 MPYU ATOD PAC SACH TEMP4 LACC #SIN_ENTRY ADD TEMP4 TBLR TEMP4 LT TEMP4 MPY M_ PAC SACH TEMP4,7 LACC TEMP4 ADD #1,14 SACL TEMP4 LT T_QUA MPYU TEMP4 PAC SACH TEMP4,2 LT TEMP5 MPYU ATOD PAC SACH TEMP5 LACC #SIN_ENTRY ADD TEMP5 TBLR TEMP5 LT TEMP5 MPY M_ PAC SACH TEMP5,7 LACC TEMP5 ADD #1,14 SACL TEMP5 LT T_QUA MPYU TEMP5 PAC SACH TEMP5,2 LT TEMP6 MPYU ATOD PAC SACH TEMP6 LACC #SIN_ENTRY ADD TEMP6 TBLR TEMP6 LT TEMP6 MPY M_ PAC SACH TEMP6,7 LACC TEMP6 ADD #1,14 SACL TEMP6 LT T_QUA MPYU TEMP6 PAC SACH TEMP6,2 LACC K_ ADD #1 SACL K_ SUB KMAX BCND WXM5,LT SPLK #0,K_ WXM5 LACC TEMP1 ADD TEMP4 SACL TEMP1 SUB PMIN BCND WXM6,GT SPLK #0,TEMP1 B WXM7WXM6 LACC TEMP1 SUB PMAX BCND WXM7,LT SPLK #2000,TEMP1 WXM7 LACC #2000 SUB TEMP1 ROR LDP #232 SACL CMPR1 LDP #6 LACC TEMP2 ADD TEMP5 SACL TEMP2 SUB PMIN BCND WXM8,GT SPLK #0,TEMP2 B WXM9WXM8 LACC TEMP2 SUB PMAX BCND WXM9,LT SPLK #2000,TEMP2 WXM9 LACC #2000 SUB TEMP2 ROR LDP #232 SACL CMPR2 LDP #6 LACC TEMP3 ADD TEMP6 SACL TEMP3 SUB PMIN BCND WXM10,GT SPLK #0,TEMP3 B WXM11WXM10 LACC TEMP3 SUB PMAX BCND WXM11,LT SPLK #2000,TEMP3 WXM11 LACC #2000 SUB TEMP3 ROR LDP #232 SACL CMPR3 LDP #6 LT P_LO MPY #1 LPH P_HI LT T_SAVE LACC ACCH,16 ADDS ACCL LDP #0 LST #ST1,ST1_SAVE LST #ST0,ST0_SAVE CLRC INTM RET .data SIN_ENTRY .word 0 .word 286,572,857,1143,1428 .word 1713,1997,2280,2563,2845 .word 3126,3406,3686,3964,4240 .word 4516, 4790,5063,5334,5604 .word 5872,6138,6402,6664, 6924 .word 7182,7438,7692,7943,8192 .word 8438,8682,8923,9162,9397 .word 9630,9860,10087,10311,10531 .word 10749,10963,11174,11381,11585 .word 11786,11982,12176,12365,12551 .word 12733,12911,13085,13255,13421 .word 13583,13741,13894,14044,14189 .word 14330,14466,14598,14726,14849 .word 14968,15082,15191,15296,15396 .word 15491,15582,15668,15749,15826 .word 15897,15964,16026,16083,16135 .word 16182,16225,16262,16294,16322 .word 16344,16362,16374,16382,16384 ；90 .word 16382,16374,16362,16344,16322 .word 16294,16262,16225,16182,16135 .word 16083,16026,15964,15897,15826 .word 15749,15668,15582,15491,15396 .word 15296,15191,15082,14968,14849 .word 14726,14598,14466,14330,14189 .word 14044,13894,13741,13583,13421 .word 13255,13085,12911,12733,12551 .word 12365,12176,11982,11786,11585 .word 11381,11174,10963,10749,10531 .word 10311,10087,9860,9630,9397 .word 9162,8923,8682,8438,8192 .word 7943,7692,7438,7182,6924 .word 6664,6402,6138,5872,5604 .word 5334,5063,4790,4516,4240 .word 3964,3686,3406,3126,2845 .word 2563,2280,1997,1713,1428 .word 1143,857,572,286, 0 ；180 .word 65250,64964,64679,64393,64108 .word 63823,63539,63256,62973,62691 .word 62410,62130,61850,61572,61296 .word 61020,60746,60473,60202,59932 .word 59664,59398,59134,58872,58612 .word 58354,58098,57844,57593,57344 .word 57098,56854,56613,56374,56139 .word 55906,55676,55449,55225,55005 .word 54787,54573,54362,54155,53951 .word 53750,53554,53360,53171,52985 .word 52803,52625,52451,52281,52115 .word 51953,51795,51642,51492,51347 .word 51206,51070,50938,50810,50687 .word 50568,50454,50345,50240,50140 .word 50045,49954, 49868,49787,49710 .word 49639,49572,49510,49453,49401