init.asm

正弦波驱动电机伺服控制汇编语言源程序！可应用于永磁同步电机

.debug
	.dw '.stabs "P_OL2_Ctrl_DEF:t171=172=u1W:26,0,16;B:173=s1OLCNT:26,0,4;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "Reserved:26,4,2;OLIF:26,6,1;OLIE:26,7,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "RTOL:26,8,1;RTPWM:26,9,1;RTTMB:26,10,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "OLST:26,11,1;OLMD:26,12,2;CNTSP:26,14,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "OLEN:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_Fault1_Release_DEF:t174=175=u1W:26,0,16;B:176=s1FTRR:26,0,16;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_Fault2_Release_DEF:t177=178=u1W:26,0,16;B:179=s1FTRR:26,0,16;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_ADC_Setup_DEF:t180=181=u1W:26,0,16;B:182=s1Reserved1:26,0,7;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "ASPEN:26,7,1;ADCEXTRG:26,8,1;ADCFS:26,9,2;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "Reserved2:26,11,1;VRXEN:26,12,1;Reserved3:26,13,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "ADCEN:26,14,1;ADCCS:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_ADC_Ctrl_DEF:t183=184=u1W:26,0,16;B:185=s1ADCCHS:26,0,3;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "Reserved1:26,3,3;ADCSTR:26,6,1;ADCRDY:26,7,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "Reserved2:26,8,6;ADCIE:26,14,1;ADCIF:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_ADC_Channel_DEF:t186=187=u1W:26,0,16;B:188=s1ADCCH0:26,0,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "ADCCH1:26,1,1;ADCCH2:26,2,1;ADCCH3:26,3,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "ADCCH4:26,4,1;ADCCH5:26,5,1;ADCCH6:26,6,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "ADCCH7:26,7,1;reserved:26,8,8;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_ADC_Data_DEF:t189=190=u1W:26,0,16;B:191=s1reserved:26,0,6;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "ADCData:26,6,10;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_SPI_Ctrl_DEF:t192=193=u1W:26,0,16;B:194=s1SPIFS:26,0,3;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "SPISMPS:26,3,1;SPIPOL:26,4,1;SPIPHA:26,5,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "Reserved1:26,6,2;SPIMS:26,8,1;SPISPCLK:26,9,2;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "SPIRST:26,11,1;Reserved2:26,12,3;SPIE:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_SPI_TxStatus_DEF:t195=196=u1W:26,0,16;B:197=s1Reserved:26,0,13;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "SPITXBF:26,13,1;SPITXIE:26,14,1;SPITXIF:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_SPI_TxBuf_DEF:t198=199=u1W:26,0,16;B:200=s1SPITXBUF:26,0,8;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "reserved:26,8,8;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_SPI_RxStatus_DEF:t201=202=u1W:26,0,16;B:203=s1Reserved1:26,0,10;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "FERR:26,10,1;Reserved2:26,11,3;SPIRXIE:26,14,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "SPIRXIF:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_SPI_RxBuf_DEF:t204=205=u1W:26,0,16;B:206=s1SPIRXBUF:26,0,8;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "reserved:26,8,8;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_Reset_Status_DEF:t207=208=u1W:26,0,16;B:209=s1EXTRF:26,0,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "PORF:26,1,1;WDRF:26,2,1;LVRF:26,3,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "reserved1:26,4,1;IARF:26,5,1;IIRF:26,6,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "reserved2:26,7,2;FCHK:26,9,7;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_Clk_Ctrl_DEF:t210=211=u1W:26,0,16;B:212=s1reserved:26,0,14;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "OSCIE:26,14,1;OSCSF:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_System_Option_DEF:t213=214=u1W:26,0,16;B:215=s1CLK:26,0,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "WDG:26,1,1;LVR:26,2,1;LVD:26,3,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "Security:26,4,1;Verification:26,5,11;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_WatchDog_Ctrl_DEF:t216=217=u1W:26,0,16;B:218=s1WDPS:26,0,3;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "WDCHK:26,3,5;reserved:26,8,6;WDRS:26,14,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "WDEN:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_WatchDog_Clr_DEF:t219=220=u1W:26,0,16;B:221=s1WDTCLR:26,0,16;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_Wakeup_Ctrl_DEF:t222=223=u1W:26,0,16;B:224=s1Reserve1:26,0,4;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "CMTWE:26,4,1;PDC0WE:26,5,1;PDC1WE:26,6,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "TPM2WE:26,7,1;reserved2:26,8,3;EXT0WE:26,11,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "EXT1WE:26,12,1;SPIWE:26,13,1;UARTWE:26,14,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "KEYWE:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_UART_Data_DEF:t225=226=u1W:26,0,16;B:227=s1UARTDATA:26,0,8;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "FE:26,8,1;PE:26,9,1;reserved1:26,10,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "OE:26,11,1;reserved2:26,12,4;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_UART_RXStatus_DEF:t228=229=u1W:26,0,16;B:230=s1FE:26,0,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "PE:26,1,1;reserve1:26,2,1;OE:26,3,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "reserved2:26,4,12;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_UART_Ctrl_DEF:t231=232=u1W:26,0,16;B:233=s1reserved1:26,0,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "PEN:26,1,1;PSEL:26,2,1;SBSEL:26,3,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "reserved2:26,4,5;RXCHSEL:26,9,1;TXCHSEL:26,10,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "Reset:26,11,1;TXEN:26,12,1;RXEN:26,13,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "TXIE:26,14,1;RXIE:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_UART_BaudRate_DEF:t234=235=u1W:26,0,16;B:236=s1UARTBUD:26,0,16;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_UART_Status_DEF:t237=238=u1W:26,0,16;B:239=s1reserved1:26,0,3;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "BY:26,3,1;reserved2:26,4,2;RXBF:26,6,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "reserved3:26,7,7;TXIF:26,14,1;RXIF:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_INT_Status_DEF:t240=241=u1W:26,0,16;B:242=s1FTIF:26,0,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "OSCSF:26,1,1;OLIF:26,2,1;reserved:26,3,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "CMTIF:26,4,1;PDC0IF:26,5,1;PDC1IF:26,6,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "TPM2IF:26,7,1;MCP3IF:26,8,1;MCP4IF:26,9,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "ADCIF:26,10,1;EXT0IF:26,11,1;EXT1IF:26,12,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "SPIIF:26,13,1;UARTIF:26,14,1;KEYIF:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_INT_Priority_DEF:t243=244=u1W:26,0,16;B:245=s1FTIP:26,0,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "OSCIP:26,1,1;OLIP:26,2,1;reserved1:26,3,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "CMTIP:26,4,1;PDC0IP:26,5,1;PDC1IP:26,6,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "TPM2IP:26,7,1;MCP3IP:26,8,1;MCP4IP:26,9,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "ADCIP:26,10,1;EXTIP:26,11,1;reserved2:26,12,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "SPIIP:26,13,1;UARTIP:26,14,1;KEYIP:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_MisINT_Ctrl_DEF:t246=247=u1W:26,0,16;B:248=s1reserved1:26,0,11;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "EXT0IE:26,11,1;EXT1IE:26,12,1;EXT0MS:26,13,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "EXT1MS:26,14,1;KEYIE:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_Flash_RW_DEF:t249=250=u1W:26,0,16;B:251=s1BK0WENB:26,0,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "BK1WENB:26,1,1;BK2WENB:26,2,1;BK3WENB:26,3,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "BK4WENB:26,4,1;BK5WENB:26,5,1;BK6WENB:26,6,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "BK7WENB:26,7,1;BK8WENB:26,8,1;BK9WENB:26,9,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "BK10WENB:26,10,1;BK11WENB:26,11,1;BK12WENB:26,12,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "BK13WENB:26,13,1;BK14WENB:26,14,1;BK15WENB:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_Flash_Cmd_DEF:t252=253=u1W:26,0,16;B:254=s1Reserve:26,0,16;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_CMT_Start_DEF:t255=256=u1W:26,0,16;B:257=s1ST0:26,0,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "ST1:26,1,1;Rerserved:26,2,14;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_CMT_Ctrl_DEF:t258=259=u1W:26,0,16;B:260=s1CKA:26,0,3;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "Reserved1:26,3,3;CM0IE:26,6,1;CM0IF:26,7,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "CKB:26,8,3;Reserved2:26,11,3;CM1IE:26,14,1;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "CM1IF:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "P_BZO_Ctrl_DEF:t261=262=u1W:26,0,16;B:263=s1BZOCK:26,0,2;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "Reserved:26,2,13;BZOEN:26,15,1;;,0,16;;",128,0,0,0',0x0d,0x0a
.CODE
.debug
	.dw '.stabs "SPWM:T264=s6SPWM_flag:45,0,16;uiPhases_Temp:4,16,16;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "uiAM_Temp:4,32,16;uiPWM_period:4,48,16;Currently_F:4,64,16;\\",128,0,0,0',0x0d,0x0a
	.DW '.stabs "End_F:4,80,16;;",128,0,0,0',0x0d,0x0a
.CODE
.code
.debug
	.dw '.stabs "MCP4_T_PWM_init:F19",36,0,0,',0,0,offset _MCP4_T_PWM_init,seg _MCP4_T_PWM_init,0x0d,0x0a
.CODE
.public _MCP4_T_PWM_init
_MCP4_T_PWM_init:	.proc
.debug
	.dw '.stabn 0x44,0,11,',0,0
	.dd LM1-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM1:
	// total=0, vars=0
	// frame_pointer_needed: 1
	push bp to [sp]
	bp=sp+1

	R1=BP+3
.debug
	.dw '.stabn 0x44,0,13,',0,0
	.dd LM2-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM2:
	R2=[28786]	// QImode move
	R3=R2|(-1024)
	[28786]=R3	// QImode move
.debug
	.dw '.stabn 0x44,0,14,',0,0
	.dd LM3-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM3:
	R2=[28787]	// QImode move
	R3=R2|(-1024)
	[28787]=R3	// QImode move
.debug
	.dw '.stabn 0x44,0,15,',0,0
	.dd LM4-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM4:
	R2=[28802]	// QImode move
	R3=R2|(-1024)
	[28802]=R3	// QImode move
.debug
	.dw '.stabn 0x44,0,17,',0,0
	.dd LM5-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM5:
	R2=[29705]	// QImode move
	R3=R2|23042
	[29705]=R3	// QImode move
.debug
	.dw '.stabn 0x44,0,23,',0,0
	.dd LM6-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM6:
	R2=10464	// QImode move
	[29700]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,26,',0,0
	.dd LM7-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM7:
	R2=546	// QImode move
	[29716]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,27,',0,0
	.dd LM8-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM8:
	R2=[29732]	// QImode move
	R3=R2|16
	[29732]=R3	// QImode move
.debug
	.dw '.stabn 0x44,0,32,',0,0
	.dd LM9-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM9:
	R2=[29793]	// QImode move
	R3=R2|28679
	[29793]=R3	// QImode move
.debug
	.dw '.stabn 0x44,0,39,',0,0
	.dd LM10-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM10:
	R2=16128	// QImode move
	[29702]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,44,',0,0
	.dd LM11-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM11:
	R2=(-14529)	// QImode move
	[29704]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,45,',0,0
	.dd LM12-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM12:
	R2=1024	// QImode move
	[29753]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,46,',0,0
	.dd LM13-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM13:
	R2=0	// QImode move
	[29772]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,47,',0,0
	.dd LM14-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM14:
	R2=0	// QImode move
	[29773]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,48,',0,0
	.dd LM15-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM15:
	R2=0	// QImode move
	[29774]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,50,',0,0
	.dd LM16-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM16:
	R2=170	// QImode move
	[29706]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,51,',0,0
	.dd LM17-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM17:
	R2=[29701]	// QImode move
	R3=R2|16
	[29701]=R3	// QImode move
.debug
	.dw '.stabn 0x44,0,52,',0,0
	.dd LM18-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM18:
.debug
	.dw '.stabn 0x44,0,52,',0,0
	.dd LM19-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LM19:
L2:

	pop bp from [sp]
	retf
	.endp	// end of MCP4_T_PWM_init

.debug
	.dw '.stabf ',0,0
	.dd LME1-_MCP4_T_PWM_init
	.dw 0x0d,0x0a
.code
LME1:
	.end