capture.asm

2407的捕获程序 用于电机驱动 里面含有中断的配置！

	.global	AAA
	.global	CAP4TEMP
	.global	BB

AAA			 .usect		 ".data0",1
CAP4TEMP     .usect      ".data0",1
	.bss 	BB,1
             .include    "F2407REGS.H"
             .def        _c_int0
             .global	I$$SAVE
             .sect       ".vectors"
RSVECT       B           _c_int0
INT1         B           PHANTOM
INT2         B           PHANTOM
INT3         B           PHANTOM
INT4         B           GISR4
             .sect       ".pvecs"
PVECTORS     B           PHANTOM;1
             B           PHANTOM;2
             B           PHANTOM;3
             B           PHANTOM;4
             B           PHANTOM;5
             B           PHANTOM;6
             B           PHANTOM;7
             B           PHANTOM;8
             B           PHANTOM;9
             B           PHANTOM;A
             B           PHANTOM;B
             B           PHANTOM;C
             B           PHANTOM;D
             B           PHANTOM;E
             B           PHANTOM;F
             B           PHANTOM;0
             B           PHANTOM;1
             B           PHANTOM;2
             B           PHANTOM;3
             B           PHANTOM;4
             B           PHANTOM;5
             B           PHANTOM;6
             B           PHANTOM;7
             B           PHANTOM;8
             B           PHANTOM;9
             B           PHANTOM;A
             B           PHANTOM;B
             B           PHANTOM;C
             B           PHANTOM;D
             B           PHANTOM;E
             B           PHANTOM;F
             B           PHANTOM;0
             B           PHANTOM;1
             B           PHANTOM;2
             B           PHANTOM;3
             B           PHANTOM;4
             B           PHANTOM;5
             B           CAP4_ISR
             .text
_c_int0
             LDP         #BB>>7
             SPLK		 #0AAAAH,BB
             SPLK        #0,CAP4TEMP
             SPLK		 #0aah,AAA
             CALL        SYSINIT
             CALL        CAP_INIT
WAIT
             NOP
             B           WAIT
SYSINIT:
             SETC        INTM
             CLRC        SXM
             CLRC        OVM
             CLRC        CNF
             LDP         #0E0H
             SPLK        #81FEH,SCSR1
             SPLK        #0E8H,WDCR
             LDP         #0
             SPLK        #0008H,IMR
             SPLK        #0FFFFH,IFR
             RET
CAP_INIT:
             LDP         #DP_PF2
             LACL        MCRC
             OR          #0380H
             SACL        MCRC
             SETC        INTM
             LDP         #DP_EVB
             SPLK        #049H,GPTCONB
             SPLK        #0,T3CNT
             SPLK        #01742H,T3CON 
             SPLK        #0FFFFH,T3PR
             SPLK        #00H,EVBIMRA
             SPLK        #00H,EVBIMRB
             SPLK        #22C0H,CAPCONB
             SPLK        #01H,EVBIMRC
             SPLK        #0FFFFH,EVBIFRA
             SPLK        #0FFFFH,EVBIFRB
             SPLK        #0FFFFH,EVBIFRC
             CLRC        INTM
             RET
GISR4:
             LDP         #0E0H
             LACC        PIVR,1
             ADD         #PVECTORS
             BACC
CAP4_ISR:
			 CALL	I$$SAVE
             LDP         #DP_EVB
             LACL        CAP4FIFO
             LDP         #5
             SACL        CAP4TEMP
             LDP         #DP_EVB
             SPLK        #0,T3CNT
GISR2_RET:
             CLRC        INTM
             RET             
PHANTOM      
             KICK_DOG
             RET
             END