FreeCalypso > hg > efr-experiments
diff src/syn_filt.c @ 0:56410792419a
src: original EFR source from ETSI
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Wed, 03 Apr 2024 05:31:37 +0000 |
parents | |
children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/syn_filt.c Wed Apr 03 05:31:37 2024 +0000 @@ -0,0 +1,68 @@ +/************************************************************************* + * + * FUNCTION: Syn_filt: + * + * PURPOSE: Perform synthesis filtering through 1/A(z). + * + *************************************************************************/ + +#include "typedef.h" +#include "basic_op.h" +#include "count.h" + +/* m = LPC order == 10 */ +#define m 10 + +void Syn_filt ( + Word16 a[], /* (i) : a[m+1] prediction coefficients (m=10) */ + Word16 x[], /* (i) : input signal */ + Word16 y[], /* (o) : output signal */ + Word16 lg, /* (i) : size of filtering */ + Word16 mem[], /* (i/o) : memory associated with this filtering. */ + Word16 update /* (i) : 0=no update, 1=update of memory. */ +) +{ + Word16 i, j; + Word32 s; + Word16 tmp[80]; /* This is usually done by memory allocation (lg+m) */ + Word16 *yy; + + /* Copy mem[] to yy[] */ + + yy = tmp; move16 (); + + for (i = 0; i < m; i++) + { + *yy++ = mem[i]; move16 (); + } + + /* Do the filtering. */ + + for (i = 0; i < lg; i++) + { + s = L_mult (x[i], a[0]); + for (j = 1; j <= m; j++) + { + s = L_msu (s, a[j], yy[-j]); + } + s = L_shl (s, 3); + *yy++ = round (s); move16 (); + } + + for (i = 0; i < lg; i++) + { + y[i] = tmp[i + m]; move16 (); + } + + /* Update of memory if update==1 */ + + test (); + if (update != 0) + { + for (i = 0; i < m; i++) + { + mem[i] = y[lg - m + i]; move16 (); + } + } + return; +}