;***************************************************************************
;	testflt1.asm
;		Test des fonctions de filtrage de filtre.asm        
;		TP/projets DSP EFREI 2002-2003, Benoît Decoux
;***************************************************************************
      nolist
      include 'ioequ.asm'
      include 'intequ.asm'
      include 'ada_equ.asm'
      include 'vectors.asm'  
      list

;******************************************************************************

;---Buffer for talking to the CS4215

       org    x:0
RX_BUFF_BASE	equ     *
RX_data_1_2	ds	1	;data time slot 1/2 for RX ISR
RX_data_3_4	ds	1	;data time slot 3/4 for RX ISR
RX_data_5_6	ds	1	;data time slot 5/6 for RX ISR
RX_data_7_8	ds	1	;data time slot 7/8 for RX ISR

TX_BUFF_BASE	equ	*
TX_data_1_2	ds	1	;data time slot 1/2 for TX ISR
TX_data_3_4	ds	1	;data time slot 3/4 for TX ISR
TX_data_5_6	ds	1	;data time slot 5/6 for TX ISR
TX_data_7_8	ds	1	;data time slot 7/8 for TX ISR

RX_PTR          ds      1	; Pointer for rx buffer
TX_PTR          ds      1	; Pointer for tx buffer

TONE_OUTPUT     EQU     HEADPHONE_EN+LINEOUT_EN+(4*LEFT_ATTN)+(4*RIGHT_ATTN)   
TONE_INPUT      EQU     MIC_IN_SELECT+(15*MONITOR_ATTN)
CTRL_WD_12	equ	NO_PREAMP+HI_PASS_FILT+SAMP_RATE_48+STEREO+DATA_16   ;CLB=0
CTRL_WD_34	equ	IMMED_3STATE+XTAL1_SELECT+BITS_64+CODEC_MASTER
CTRL_WD_56	equ	$000000
CTRL_WD_78	equ	$000000


        org     p:$100
START
main
        movep   #$040003,X:M_PCTL	; set PLL for MPY of 4X
        movep   #$012421,X:M_BCR	; set up one ext. wait state for all AAR areas
        ori     #3,mr			; mask interrupts
        movec   #0,sp			; clear hardware stack pointer
        move    #0,omr			; operating mode 0
        move    #$40,r6			; initialise stack pointer
        move    #-1,m6			; linear addressing
        jsr     ada_init		; initialize codec
	jsr	init_filtre		; initialisation des paramètres du filtre
loop_1
        
        jset    #2,X:M_SSISR0,*		; wait for frame sync to pass
        jclr    #2,X:M_SSISR0,*		; wait for frame sync

        move    X:RX_BUFF_BASE,B        ; receive left
        move    X:RX_BUFF_BASE+1,A      ; receive right

        jsr     process_stereo

        move    A,X:TX_BUFF_BASE        ; transmit left
        move    A,X:TX_BUFF_BASE+1      ; transmit right
        
        move    #TONE_OUTPUT,y0		;set up control words
        move    Y0,X:TX_BUFF_BASE+2
        move    #TONE_INPUT,y0
        move    Y0,X:TX_BUFF_BASE+3

        jmp     loop_1

        include 'ada_init.asm'
	  include '../prog/filtre_4.asm'		;INCLUDE YOUR OWN .ASM HERE

echo

process_stereo
        jsr	filtrage				;JUMP TO YOUR PROCESSING SUBROUTINE HERE
        rts

        end