mag_128.asm

(Ebook-Pdf) Dsp - Real Time Digital Signal Processing (Usando Tms320-55Xx). 有书

;
;   Compute the magnitude of the input complex sample
;
;   Entry: AR0: input buffer pointer
;          AR1: output buffer pointer
;   Exit: None
;
    .def   _mag_128
N   .set   128

    .text
_mag_128
   bset    SATD
   pshboth XAR5
   mov     #N-1,BRC0       ; Set BRC0 for loop N times
   mov     XAR0,XAR5
   bset    FRCT
   rptblocal mag_loop-1
   mpym    *AR0+,*AR5+,AC0 ; Xr[i]*Xr[i]
   macm    *AR0+,*AR5+,AC0 ; Xr[i]*Xr[i]+Xi[i]*Xi[i]
   mov     hi(saturate(AC0)),*AR1+
mag_loop
   popboth XAR5
   bclr    SATD
   bclr    FRCT
   ret
   .end