#ifndef NEW_PLC #define NEW_PLC #endif #ifdef FIXED_POINT static celt_word32 frac_div32(celt_word32 a, celt_word32 b) { celt_word16 rcp; celt_word32 result, rem; int shift = 30-celt_ilog2(b); a = SHL32(a,shift); b = SHL32(b,shift); /* 16-bit reciprocal */ rcp = ROUND16(celt_rcp(ROUND16(b,16)),2); result = SHL32(MULT16_32_Q15(rcp, a),1); rem = a-MULT32_32_Q31(result, b); result += SHL32(MULT16_32_Q15(rcp, rem),1); return result; } #else #define frac_div32(a,b) ((float)(a)/(b)) #endif void _celt_lpc( celt_word16 *_lpc, /* out: [0...p-1] LPC coefficients */ const celt_word32 *ac, /* in: [0...p] autocorrelation values */ int p ) { int i, j; celt_word32 r; celt_word32 error = ac[0]; #ifdef FIXED_POINT celt_word32 lpc[LPC_ORDER]; #else float *lpc = _lpc; #endif for (i = 0; i < p; i++) lpc[i] = 0; if (ac[0] != 0) { for (i = 0; i < p; i++) { /* Sum up this iteration's reflection coefficient */ celt_word32 rr = 0; for (j = 0; j < i; j++) rr += MULT32_32_Q31(lpc[j],ac[i - j]); rr += SHR32(ac[i + 1],3); r = -frac_div32(SHL32(rr,3), error); /* Update LPC coefficients and total error */ lpc[i] = SHR32(r,3); for (j = 0; j < (i+1)>>1; j++) { celt_word32 tmp1, tmp2; tmp1 = lpc[j]; tmp2 = lpc[i-1-j]; lpc[j] = tmp1 + MULT32_32_Q31(r,tmp2); lpc[i-1-j] = tmp2 + MULT32_32_Q31(r,tmp1); } error = error - MULT32_32_Q31(MULT32_32_Q31(r,r),error); /* Bail out once we get 30 dB gain */ #ifdef FIXED_POINT if (error=1;j--) { mem[j]=mem[j-1]; } mem[0] = x[i]; y[i] = ROUND16(sum, SIG_SHIFT); } } void iir(const celt_word32 *x, const celt_word16 *den, celt_word32 *y, int N, int ord, celt_word16 *mem) { int i,j; for (i=0;i=1;j--) { mem[j]=mem[j-1]; } mem[0] = ROUND16(sum,SIG_SHIFT); y[i] = sum; } } void _celt_autocorr( const celt_word16 *x, /* in: [0...n-1] samples x */ celt_word32 *ac, /* out: [0...lag-1] ac values */ const celt_word16 *window, int overlap, int lag, int n ) { celt_word32 d; int i; VARDECL(celt_word16, xx); SAVE_STACK; ALLOC(xx, n, celt_word16); for (i=0;i=0) { for (i = lag, d = 0; i < n; i++) d += xx[i] * xx[i-lag]; ac[lag] = d; /*printf ("%f ", ac[lag]);*/ lag--; } /*printf ("\n");*/ ac[0] += 10; RESTORE_STACK; }