iir.asm

dsp5000

;DXR11      .set    43h
;DRR11      .set    41h
          .mmregs
          .global   iir
N         .set   4
Q_FACT    .set   32768
          .bss   d,3*4+2
          .bss   X,1
          .bss   Y,1
          .data
          
table:
    ;second-order  section #01
           
          .word   01fch    ;b2
          .word   02c8h    ;b1
          .word   01fch    ;b0
          .word   0a36fh   ;a2                
          .word   6ae8h    ;a1/2
          
    ;second-order  section #02
       
          .word   10c1h      ;b2
          .word   0fbc0h     ;b1
          .word   10c1h      ;b0
          .word   9969h      ;a2
          .word   64aah      ;a1/2
     
     ;second-order  section #03
     
          .word   2f7bh       ;b2
          .word   0d6d7h       ;b1
          .word   2f7bh       ;b0
          .word   8d94h       ;a2
          .word   5e4fh       ;a1/2
          
     ;second-order  section #04
     
          .word    47d6h       ;b2
          .word    0b465h      ;b1
          .word    47d6h       ;b0
          .word    8423h       ;a2
          .word    5be6h       ;a1/2

            .text
         
iir:     
     
         PSHM      AL
         PSHM      AH
         PSHM      AG 
         PSHM      BL
         PSHM      BH
         PSHM      BG
         PSHM      AR0
         PSHM      AR1
         PSHM      AR2
         PSHM      AR3
         PSHM      AR4
         PSHM      AR5
         PSHM      AR6
         PSHM      AR7                                                                 
;          STM     #0000000010100000b,PMST
          STM     #0010001100000000b,ST1
          SSBX    OVM 
          STM     #0,SWWSR
          SSBX    FRCT
          SSBX    SXM 
;          RSBX      CPL
          LD        #0,DP 
          
          STM     #d,AR3
          RPTZ    A,#7
          STL     A,*AR3+
          STM     #2,AR0
          
INLOOP:

          STM     #d+13,AR3
          STM     #table,AR4
          MPY     *AR4+,*AR3-,A
          MAC     *AR4+,*AR3,A
          DELAY   *AR3-
          MAC     *AR4+,*AR3-,A
          DELAY   *AR3   
          ST      #2002H,AR5      ;
          MVDD    *AR5,*AR3   ;INPUT
          LD      *AR3,B
          STH     B,11,*AR3-
          STM     #N-2,BRC
          RPTB    ELOOP-1
          
LOOP:

          MAC     *AR4+,*AR3-,A
          MAC     *AR4,*AR3,A
          MAC     *AR4+,*AR3-,A
          STH     A,*AR3+0
          MPY     *AR4+,*AR3-,A
          MAC     *AR4+,*AR3,A
          DELAY   *AR3-
          MAC     *AR4+,*AR3,A
          DELAY   *AR3-
          
ELOOP:

          MAC     *AR4+,*AR3-,A 
          NOP
          NOP
          NOP
          MAC     *AR4,*AR3,A
          NOP
          NOP
          NOP
          NOP
          MAC     *AR4+,*AR3,A
          NOP
          NOP
          NOP
          NOP
          DELAY   *AR3
          NOP
          NOP
          STH     A,*AR3
          st      #2004h,AR2
          nop
          nop
          MVDD    *AR3,*AR2
          nop
          nop
          nop
;          STM      DXR11,AR3
;          MVKD     0b00h,*AR3    ;OUTPUT  
          
          POPM     AR7 
          POPM     AR6
          POPM     AR5
          POPM     AR4
          POPM     AR3
          POPM     AR2
          POPM     AR1
          POPM     AR0
          POPM     BG
          POPM     BH
          POPM     BL
          POPM     AG
          POPM     AH
          POPM     AL
    
          RET                                   

;          RSBX      CPL
;          LD        #0,DP 
                                                                
;          SSBX      SXM
          
;          stm       41h,AR1           
;          mvdk      *AR1,1001h           
;          stm       43h,AR1           
;          mvkd      1001h,*AR1 
          
          
          
        
;          stm     #0400H,IMR  
;          rsbx      INTM
;          rete