************************************************
* FileName:		ex10.asm                       *
* Description:	濾波器實驗                     *
* Copyright(C) SanZhi Electronic, Author Zpin  *
************************************************

		.title "ex10"

BSP			.set		1		;當前使用McBsp1

;McBsp 內存映射寄存器
SPSA0		.set    038h
SPSD0		.set    039h
DRR10		.set    021h
DRR20		.set	020h
DXR10		.set    023h
DXR20		.set	022h

SPSA1		.set    048h
SPSD1       .set    049h
DRR11       .set	041h
DRR21       .set    040h
DXR11       .set    043h
DXR21       .set	042h

SPSA2       .set    034h
SPSD2       .set    035h
DRR12       .set    031h
DRR22       .set	030h
DXR12       .set    033h
DXR22       .set	032h

;McBsp Subaddressed Registers
SPCR1		.set	00h
SPCR2		.set	01h
RCR1		.set	02h
RCR2		.set	03h
XCR1		.set	04h
XCR2		.set	05h
SRGR1		.set	06h
SRGR2		.set	07h
MCR1		.set	08h
MCR2		.set	09h
RCERA		.set	0ah
RCERB		.set	0bh
XCERA		.set	0ch
XCERB		.set	0dh
PCR			.set	0eh

		.if BSP = 0
SPSA	.set	SPSA0
SPSD	.set	SPSD0
RDRR	.set	DRR10
RDXR	.set	DXR10
IMASK	.set	0010h
		.endif
		
		.if BSP = 1
SPSA	.set	SPSA1
SPSD	.set	SPSD1
RDRR	.set	DRR11
RDXR	.set	DXR11
IMASK	.set	0400h
		.endif
		
;fin_flag		.set  64h

	.asg AR0,FIR_INDEX_P
	.asg AR4,FIR_DATA_P
	.asg AR5,FIR_COFF_P

WR_SUB_REG	.macro val,addr			;寫McBsp控制寄存器
			stm addr,SPSA
			nop
			stm val,SPSD
			nop
			.endm
			
RD_SUB_REG	.macro addr,acc			;讀McBsp控制寄存器
			stm #:addr:,SPSA
			nop
			ldm SPSD,acc
			nop
			nop
			nop
			.endm

WAITTRX   .macro					;等待串口中斷
WAITR?
        RD_SUB_REG SPCR1,A
        and #1<<1, A
        bc   WAITR?, AEQ
          .endm

PROGREG   .macro progword			;與AD50二次通訊
     
 		stm  #01h,RDXR
        WAITTRX
        stm     #:progword:,RDXR
        WAITTRX
          .endm               


wait   .macro
  		STM #0008h, AR2
		RPT *AR2
		NOP
		.endm 			

		.mmregs
		.global _c_int00


		.sect ".vectors"
RESET	b _c_int00
		nop
		nop
		.space 19*4*16
BRINT0	b recv
		nop
		nop
BXINT0	b trans
		nop
		nop
		.space 4*4*16
BRINT1	b recv
		nop
		nop
BXINT1	b trans
		nop
		nop
		.space 4*4*16
		
K_FIR_BFFR		.set 16

coff_fir_table	.sect "coff_fir"
	.word 6fh,0f3h,269h,50dh,8a9h,0c99h,0ff8h,11ebh,11ebh,0ff8h,0c99h,8a9h,50dh,269h,0f3h,64h
	;.word 42,0,-78,0,142,0,-235,0,357,0,-235,0,142,0,-78,0	
d_data_buffer	.usect "fir_bfr",40

		.text
_c_int00
		ld #0h,DP
		stm #7ffh,SP
		ssbx INTM
		ssbx SXM
        st #2491h,SWWSR
        st #0ffe0h,PMST
        ;st #0f287h,CLKMD
        
		ST #0h,CLKMD
tst:	BITF CLKMD,#1h
		BC tst,TC
		ST #1087h,CLKMD
		BITF CLKMD,#1h
		RPT #0FFh
		NOP
        
        
        stm #5000h,ar7
        stm #5000h,ar6
		
fir_init
		stm #1,AR0
		stm #coff_fir_table,FIR_COFF_P
		stm #d_data_buffer,FIR_DATA_P
		rptz A,#K_FIR_BFFR
		stl A,*FIR_DATA_P
		stm #(d_data_buffer+K_FIR_BFFR-1),FIR_DATA_P
		stm #K_FIR_BFFR,BK

        
mcbsp_init							;初始化McBsp串口
        rsbx CPL
		nop                 ; cpl latency
		nop                 ; cpl latency
		nop                 ; cpl latency

		ld #0,DP
		ssbx INTM
		ssbx SXM

		WR_SUB_REG #0000H,SPCR1
		WR_SUB_REG #0200H,SPCR2
		WR_SUB_REG #000CH,PCR
		
		WR_SUB_REG #0000H,SPCR1
		WR_SUB_REG #0000H,SPCR2
		
		WR_SUB_REG #0040H,RCR1		;16 BITs
		WR_SUB_REG #0004H,RCR2		;Ignore FS after the first
		WR_SUB_REG #0040H,XCR1		;16 BITs
		WR_SUB_REG #0004H,XCR2		;Ignore FS after the first

		ld 100,A
		wait

		andm #0ff3fh, 54h			;set interrupts to come from serial ports not DMA
									;by clearing bits 6 and 7 in DMPREC
		stm #0,RDXR
		
		WR_SUB_REG #0001H,SPCR1		;啟動McBsp串口
		WR_SUB_REG #0201H,SPCR2
		
		ld 100,A
		wait
		

aic_init
		stm #0h,IMR
		orm IMASK,IMR
		stm #0ffffh,IFR

		;PROGREG 0180H				;二次通訊初始化AD50
		;PROGREG 02C0H
		PROGREG 0301h
		PROGREG 0410h
		;PROGREG 0000001100000001b
        ; 		        876543210
        ;PROGREG 0000010000010000b
        ;		        876543210

		ld RDRR,A
		ld RDRR,A
		
		stlm A,RDXR
		stlm A,RDXR
		
		rsbx INTM
		nop
		nop
		nop
		
js		nop
		nop
		nop
		b js

recv	ldm RDRR,A				;ADC采樣數據經濾波后發送到DAC輸出
		stl A,*FIR_DATA_P+0%
		rptz A,(K_FIR_BFFR-1)
		mac *FIR_DATA_P+0%,*FIR_COFF_P+0%,A
		andm #0fffeh,ah
		sth A,RDXR
		rsbx XF
		rete
		
trans	rsbx XF
		rete
		.end