main.asm

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

	.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 "uiSPWM_phases_Add:S4",40,0,0,',0,0,offset _uiSPWM_phases_Add,seg _uiSPWM_phases_Add,0x0d,0x0a
.CODE
.debug
	.dw '.stabs "uiPhases_Temp:S4",40,0,0,',0,0,offset _uiPhases_Temp,seg _uiPhases_Temp,0x0d,0x0a
.CODE
.debug
	.dw '.stabs "SET_F:S4",40,0,0,',0,0,offset _SET_F,seg _SET_F,0x0d,0x0a
.CODE
.debug
	.dw '.stabs "SET_V:S4",40,0,0,',0,0,offset _SET_V,seg _SET_V,0x0d,0x0a
.CODE
.code
.debug
	.dw '.stabs "main:F1",36,0,0,',0,0,offset _main,seg _main,0x0d,0x0a
.CODE
.public _main
_main:	.proc
.debug
	.dw '.stabn 0x44,0,46,',0,0
	.dd LM1-_main
	.dw 0x0d,0x0a
.code
LM1:
	// total=1, vars=1
	// frame_pointer_needed: 1
	push bp to [sp]
	sp-=1
	bp=sp+1

	R1=BP+4
	[BP]=R1	// QImode move
.debug
	.dw '.stabn 0x44,0,47,',0,0
	.dd LM2-_main
	.dw 0x0d,0x0a
.code
LM2:
// GCC inline ASM start
	int off

// GCC inline ASM end
.debug
	.dw '.stabn 0x44,0,49,',0,0
	.dd LM3-_main
	.dw 0x0d,0x0a
.code
LM3:
	R1=5000	// QImode move
	[SP--]=R1	// QImode move
	call _SPWM_SET_F	// call without return value
	SP = SP + 1	//SP
.debug
	.dw '.stabn 0x44,0,50,',0,0
	.dd LM4-_main
	.dw 0x0d,0x0a
.code
LM4:
	R1=(-1)	// QImode move
	[SP--]=R1	// QImode move
	call _SPWM_SET_V	// call without return value
	SP = SP + 1	//SP
.debug
	.dw '.stabn 0x44,0,52,',0,0
	.dd LM5-_main
	.dw 0x0d,0x0a
.code
LM5:
	R1=3221	// QImode move
	[SP--]=R1	// QImode move
	R1=[_SET_F]	// QImode move
	[SP--]=R1	// QImode move
	call _ASM_MUL	// call with return value
	SP = SP + 2	//SP
	[_uiPhases_Temp]=R1	// QImode move
.debug
	.dw '.stabn 0x44,0,54,',0,0
	.dd LM6-_main
	.dw 0x0d,0x0a
.code
LM6:
	call _MCP4_T_PWM_init	// call without return value
.debug
	.dw '.stabn 0x44,0,56,',0,0
	.dd LM7-_main
	.dw 0x0d,0x0a
.code
LM7:
// GCC inline ASM start
	int irq

// GCC inline ASM end
.debug
	.dw '.stabn 0x44,0,58,',0,0
	.dd LM8-_main
	.dw 0x0d,0x0a
.code
LM8:
L3:
	pc=L5	// Indirect jump
	pc=L4	// Indirect jump
L5:
	pc=L3	// Indirect jump
L4:
.debug
	.dw '.stabn 0x44,0,59,',0,0
	.dd LM9-_main
	.dw 0x0d,0x0a
.code
LM9:
.debug
	.dw '.stabn 0x44,0,59,',0,0
	.dd LM10-_main
	.dw 0x0d,0x0a
.code
LM10:
L2:

	sp+=1
	pop bp from [sp]
	retf
	.endp	// end of main

.debug
	.dw '.stabf ',0,0
	.dd LME1-_main
	.dw 0x0d,0x0a
.code
LME1:
.code
.debug
	.dw '.stabs "SPWM_SET_F:F19",36,0,0,',0,0,offset _SPWM_SET_F,seg _SPWM_SET_F,0x0d,0x0a
.CODE
.public _SPWM_SET_F
_SPWM_SET_F:	.proc
.debug
	.dw '.stabn 0x44,0,64,',0,0
	.dd LM11-_SPWM_SET_F
	.dw 0x0d,0x0a
.code
LM11:
	// total=0, vars=0
	// frame_pointer_needed: 1
	push bp to [sp]
	bp=sp+1

	R1=BP+3
.debug
	.dw '.stabn 0x44,0,65,',0,0
	.dd LM12-_SPWM_SET_F
	.dw 0x0d,0x0a
.code
LM12:
	R3=R1	// QImode move
	R2=[R3]	// QImode move
	[_SET_F]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,66,',0,0
	.dd LM13-_SPWM_SET_F
	.dw 0x0d,0x0a
.code
LM13:
.debug
	.dw '.stabn 0x44,0,66,',0,0
	.dd LM14-_SPWM_SET_F
	.dw 0x0d,0x0a
.code
LM14:
L6:

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

.debug
	.dw '.stabs "F:p1",160,0,0,3',0x0d,0x0a
.CODE
.debug
	.dw '.stabf ',0,0
	.dd LME2-_SPWM_SET_F
	.dw 0x0d,0x0a
.code
LME2:
.code
.debug
	.dw '.stabs "SPWM_SET_V:F19",36,0,0,',0,0,offset _SPWM_SET_V,seg _SPWM_SET_V,0x0d,0x0a
.CODE
.public _SPWM_SET_V
_SPWM_SET_V:	.proc
.debug
	.dw '.stabn 0x44,0,71,',0,0
	.dd LM15-_SPWM_SET_V
	.dw 0x0d,0x0a
.code
LM15:
	// total=0, vars=0
	// frame_pointer_needed: 1
	push bp to [sp]
	bp=sp+1

	R1=BP+3
.debug
	.dw '.stabn 0x44,0,72,',0,0
	.dd LM16-_SPWM_SET_V
	.dw 0x0d,0x0a
.code
LM16:
	R3=R1	// QImode move
	R2=[R3]	// QImode move
	[_SET_V]=R2	// QImode move
.debug
	.dw '.stabn 0x44,0,73,',0,0
	.dd LM17-_SPWM_SET_V
	.dw 0x0d,0x0a
.code
LM17:
.debug
	.dw '.stabn 0x44,0,73,',0,0
	.dd LM18-_SPWM_SET_V
	.dw 0x0d,0x0a
.code
LM18:
L7:

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

.debug
	.dw '.stabs "V:p1",160,0,0,3',0x0d,0x0a
.CODE
.debug
	.dw '.stabf ',0,0
	.dd LME3-_SPWM_SET_V
	.dw 0x0d,0x0a
.code
LME3:
.code
.debug
	.dw '.stabs "SPWM_ISR:F19",36,0,0,',0,0,offset _SPWM_ISR,seg _SPWM_ISR,0x0d,0x0a
.CODE
.public _SPWM_ISR
_SPWM_ISR:	.proc
.debug
	.dw '.stabn 0x44,0,78,',0,0
	.dd LM19-_SPWM_ISR
	.dw 0x0d,0x0a
.code
LM19:
	// total=7, vars=7
	// frame_pointer_needed: 1
	push bp to [sp]
	sp-=7
	bp=sp+1

	R1=BP+10