st0_temp	.usect		".b20",1			;
st1_temp	.usect		".b20",1			;
context	 	.usect		".b20",7			;62-68 

CAP4TEMP	.usect	 ".data0",1		;CAP4 臨時寄存器
			.include  	"F2407REGS.H" ;引用頭部文件
			.def      _c_int0
;（1）建立中斷向量表
			.sect	".vectors"		;定義主向量段
RSVECT		B    _c_int0		;PM 0	復位向量  	     1
INT1	  		B    PHANTOM	;PM 2	中斷優(yōu)先級 1		4
INT2	  		B    PHANTOM	;PM 4	中斷優(yōu)先級2		5
INT3	  		B    PHANTOM	;PM 6	中斷優(yōu)先級 3		6
INT4	  		B    GISR4		;PM 8	中斷優(yōu)先級4		7
INT5	  		B    PHANTOM	;PM A	中斷優(yōu)先級 5		8
INT6	  		B    PHANTOM	;PM C	中斷優(yōu)先級 6		9
RESERVED  	B    PHANTOM	;PM E	(保留位)	          10
SW_INT8   	B    PHANTOM	;PM 10  用戶定義軟件中斷   	-
  				
SW_INT31  	B    PHANTOM	;PM 3E  用戶定義軟件中斷   	-
;中斷子向量入口定義pvecs
			.sect	".pvecs"		;定義子向量段
PVECTORS	B	PHANTOM	;保留向量地址偏移量-00H 
			B	PHANTOM	;保留向量地址偏移量-01H
  				
			B	PHANTOM	;保留向量地址偏移量-35H
			B	CAP4_ISR		;保留向量地址偏移量-36H   CAP4中斷
			B	PHANTOM	;保留向量地址偏移量-37H
  				
			B	PHANTOM	;保留向量地址偏移量-41H	
;（2）主程序
.text
_c_int0 
	LDP		#5
	SPLK	#00H,CAP4TEMP
	CALL	SYSINIT
	CALL	CAP_INIT		;調(diào)CAP4初始化程序
LOOP
	NOP
	B		LOOP
;（3）系統(tǒng)初始化程序
SYSINIT:
		SETC 	INTM
		CLRC 	SXM
       	CLRC 	OVM
		CLRC 	CNF			;B0區(qū)被配置為數(shù)據(jù)空間
        LDP 		#0E0H		;指向7000h-7080h區(qū)
       	SPLK 	#81FEH,SCSR1   ;時鐘4倍頻,CLKIN=6M,CLKOUT=24M
        SPLK		#0E8H,WDCR	;不使能WDT
	    LDP		#0
		SPLK		#0008H,IMR	;使能中斷第4級INT4
		SPLK		#0FFFFH,IFR	;清全部中斷標志
		RET
;（4）捕獲單元初始化程序
CAP_INIT:
	LDP		#DP_PF2		;指向7090H－7100H
	LACL	MCRC
	OR		#0380H  		;IOPE7, IOPF0, IOPF1 被配置為特殊功
	SACL	MCRC		;能方式:CAP[4-6]
	SETC 	INTM
	LDP		#DP_EVB
	SPLK 	#049H,GPTCONB;TCOMPOE=1,T4PIN=10,T3PIN=01 
	SPLK	#0,T3CNT
	SPLK   	#01742H,T3CON ;TMODE=10 連續(xù)向上計數(shù)模式,TPS=111 預分頻為128
								;TENABLE=1 定時器計數(shù)使能, TCLKS=00 內(nèi)部時鐘
							;TCLD=00, TECMPR=1 定時器3比較使能, SELT3PR=0
	SPLK 	#0FFFFH,T3PR	;定時器周期比較寄存器設(shè)為最大
	SPLK 	#00H,EVBIMRA
	SPLK 	#00H,EVBIMRB
	SPLK 	#22C0H,CAPCONB;CAP4 捕獲允許,捕獲上升沿
	SPLK 	#01H,EVBIMRC;CAP4 中斷使能
	SPLK 	#0FFFFh,EVBIFRA ;清 EVB 全部中斷標志
	SPLK 	#0FFFFh,EVBIFRB
	SPLK 	#0FFFFh,EVBIFRC
	CLRC 	INTM 		;開總中斷
	RET		
;（5）中斷程序程序
GISR4:						;優(yōu)先級INT4中斷人口
		;保護現(xiàn)場
		LDP     #0              ;保存機器上下文
		SST		#0,st0_temp	    ;使用自動尋址,DP-0 
		SST		#1,st1_temp	    ;保存狀態(tài)寄存器到B2 DARAM.
		LDP		#0			  
        SACL	context			;保存ACC的低16位
		SACH	context+1		;保存ACC的高16位
		SAR		AR1,context+2
		SAR		AR2,context+3
		SAR		AR3,context+4
		SAR		AR4,context+5		
		SAR		AR5,context+6
		LDP		#0E0H
		LACC	PIVR,1		;讀取外設(shè)中斷向量寄存器（PIVR）,并左移一位
		ADD		#PVECTORS	;加上外設(shè)中斷人口地址
		BACC				;跳到相應的中斷服務子程序
CAP4_ISR:					;捕獲單元4中斷程序入口
	LDP 		#DP_EVB
	LACL	CAP4FIFO
	LDP		#5
	SACL	CAP4TEMP	;讀出捕獲的值
	LDP		#DP_EVB
	SPLK		#0,T3CNT	;清 T3 計數(shù)值,使其重新計數(shù)
GISR2_RET:					;中斷返回
		;恢復現(xiàn)場
		LDP		#DP_EVA
		SPLK	#0FFFFH,EVAIFRA
		LDP		#0
		LAR		AR5,context+6	
		LAR		AR4,context+5	
		LAR		AR3,context+4		
		LAR		AR2,context+3		
		LAR		AR1,context+2
		LACC	context+1,16
		ADDS	context
		LST		#1, st1_temp
		LST		#0, st0_temp
		CLRC	INTM		;開總中斷,因為一進中斷就自動關(guān)閉總中斷
		RET
;（6）假中斷程序
PHANTOM 	
		KICK_DOG			;復位看門狗
		RET
		END