1*28e138c6SAndroid Build Coastguard Worker /* Copyright (C) 2003-2008 Jean-Marc Valin
2*28e138c6SAndroid Build Coastguard Worker
3*28e138c6SAndroid Build Coastguard Worker File: mdf.c
4*28e138c6SAndroid Build Coastguard Worker Echo canceller based on the MDF algorithm (see below)
5*28e138c6SAndroid Build Coastguard Worker
6*28e138c6SAndroid Build Coastguard Worker Redistribution and use in source and binary forms, with or without
7*28e138c6SAndroid Build Coastguard Worker modification, are permitted provided that the following conditions are
8*28e138c6SAndroid Build Coastguard Worker met:
9*28e138c6SAndroid Build Coastguard Worker
10*28e138c6SAndroid Build Coastguard Worker 1. Redistributions of source code must retain the above copyright notice,
11*28e138c6SAndroid Build Coastguard Worker this list of conditions and the following disclaimer.
12*28e138c6SAndroid Build Coastguard Worker
13*28e138c6SAndroid Build Coastguard Worker 2. Redistributions in binary form must reproduce the above copyright
14*28e138c6SAndroid Build Coastguard Worker notice, this list of conditions and the following disclaimer in the
15*28e138c6SAndroid Build Coastguard Worker documentation and/or other materials provided with the distribution.
16*28e138c6SAndroid Build Coastguard Worker
17*28e138c6SAndroid Build Coastguard Worker 3. The name of the author may not be used to endorse or promote products
18*28e138c6SAndroid Build Coastguard Worker derived from this software without specific prior written permission.
19*28e138c6SAndroid Build Coastguard Worker
20*28e138c6SAndroid Build Coastguard Worker THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21*28e138c6SAndroid Build Coastguard Worker IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22*28e138c6SAndroid Build Coastguard Worker OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
23*28e138c6SAndroid Build Coastguard Worker DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
24*28e138c6SAndroid Build Coastguard Worker INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
25*28e138c6SAndroid Build Coastguard Worker (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
26*28e138c6SAndroid Build Coastguard Worker SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27*28e138c6SAndroid Build Coastguard Worker HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
28*28e138c6SAndroid Build Coastguard Worker STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
29*28e138c6SAndroid Build Coastguard Worker ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30*28e138c6SAndroid Build Coastguard Worker POSSIBILITY OF SUCH DAMAGE.
31*28e138c6SAndroid Build Coastguard Worker */
32*28e138c6SAndroid Build Coastguard Worker
33*28e138c6SAndroid Build Coastguard Worker /*
34*28e138c6SAndroid Build Coastguard Worker The echo canceller is based on the MDF algorithm described in:
35*28e138c6SAndroid Build Coastguard Worker
36*28e138c6SAndroid Build Coastguard Worker J. S. Soo, K. K. Pang Multidelay block frequency adaptive filter,
37*28e138c6SAndroid Build Coastguard Worker IEEE Trans. Acoust. Speech Signal Process., Vol. ASSP-38, No. 2,
38*28e138c6SAndroid Build Coastguard Worker February 1990.
39*28e138c6SAndroid Build Coastguard Worker
40*28e138c6SAndroid Build Coastguard Worker We use the Alternatively Updated MDF (AUMDF) variant. Robustness to
41*28e138c6SAndroid Build Coastguard Worker double-talk is achieved using a variable learning rate as described in:
42*28e138c6SAndroid Build Coastguard Worker
43*28e138c6SAndroid Build Coastguard Worker Valin, J.-M., On Adjusting the Learning Rate in Frequency Domain Echo
44*28e138c6SAndroid Build Coastguard Worker Cancellation With Double-Talk. IEEE Transactions on Audio,
45*28e138c6SAndroid Build Coastguard Worker Speech and Language Processing, Vol. 15, No. 3, pp. 1030-1034, 2007.
46*28e138c6SAndroid Build Coastguard Worker http://people.xiph.org/~jm/papers/valin_taslp2006.pdf
47*28e138c6SAndroid Build Coastguard Worker
48*28e138c6SAndroid Build Coastguard Worker There is no explicit double-talk detection, but a continuous variation
49*28e138c6SAndroid Build Coastguard Worker in the learning rate based on residual echo, double-talk and background
50*28e138c6SAndroid Build Coastguard Worker noise.
51*28e138c6SAndroid Build Coastguard Worker
52*28e138c6SAndroid Build Coastguard Worker About the fixed-point version:
53*28e138c6SAndroid Build Coastguard Worker All the signals are represented with 16-bit words. The filter weights
54*28e138c6SAndroid Build Coastguard Worker are represented with 32-bit words, but only the top 16 bits are used
55*28e138c6SAndroid Build Coastguard Worker in most cases. The lower 16 bits are completely unreliable (due to the
56*28e138c6SAndroid Build Coastguard Worker fact that the update is done only on the top bits), but help in the
57*28e138c6SAndroid Build Coastguard Worker adaptation -- probably by removing a "threshold effect" due to
58*28e138c6SAndroid Build Coastguard Worker quantization (rounding going to zero) when the gradient is small.
59*28e138c6SAndroid Build Coastguard Worker
60*28e138c6SAndroid Build Coastguard Worker Another kludge that seems to work good: when performing the weight
61*28e138c6SAndroid Build Coastguard Worker update, we only move half the way toward the "goal" this seems to
62*28e138c6SAndroid Build Coastguard Worker reduce the effect of quantization noise in the update phase. This
63*28e138c6SAndroid Build Coastguard Worker can be seen as applying a gradient descent on a "soft constraint"
64*28e138c6SAndroid Build Coastguard Worker instead of having a hard constraint.
65*28e138c6SAndroid Build Coastguard Worker
66*28e138c6SAndroid Build Coastguard Worker */
67*28e138c6SAndroid Build Coastguard Worker
68*28e138c6SAndroid Build Coastguard Worker #ifdef HAVE_CONFIG_H
69*28e138c6SAndroid Build Coastguard Worker #include "config.h"
70*28e138c6SAndroid Build Coastguard Worker #endif
71*28e138c6SAndroid Build Coastguard Worker
72*28e138c6SAndroid Build Coastguard Worker #include "arch.h"
73*28e138c6SAndroid Build Coastguard Worker #include "speex/speex_echo.h"
74*28e138c6SAndroid Build Coastguard Worker #include "fftwrap.h"
75*28e138c6SAndroid Build Coastguard Worker #include "pseudofloat.h"
76*28e138c6SAndroid Build Coastguard Worker #include "math_approx.h"
77*28e138c6SAndroid Build Coastguard Worker #include "os_support.h"
78*28e138c6SAndroid Build Coastguard Worker
79*28e138c6SAndroid Build Coastguard Worker #ifndef M_PI
80*28e138c6SAndroid Build Coastguard Worker #define M_PI 3.14159265358979323846
81*28e138c6SAndroid Build Coastguard Worker #endif
82*28e138c6SAndroid Build Coastguard Worker
83*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
84*28e138c6SAndroid Build Coastguard Worker #define WEIGHT_SHIFT 11
85*28e138c6SAndroid Build Coastguard Worker #define NORMALIZE_SCALEDOWN 5
86*28e138c6SAndroid Build Coastguard Worker #define NORMALIZE_SCALEUP 3
87*28e138c6SAndroid Build Coastguard Worker #else
88*28e138c6SAndroid Build Coastguard Worker #define WEIGHT_SHIFT 0
89*28e138c6SAndroid Build Coastguard Worker #endif
90*28e138c6SAndroid Build Coastguard Worker
91*28e138c6SAndroid Build Coastguard Worker /* If enabled, the AEC will use a foreground filter and a background filter to be more robust to double-talk
92*28e138c6SAndroid Build Coastguard Worker and difficult signals in general. The cost is an extra FFT and a matrix-vector multiply */
93*28e138c6SAndroid Build Coastguard Worker #define TWO_PATH
94*28e138c6SAndroid Build Coastguard Worker
95*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
96*28e138c6SAndroid Build Coastguard Worker static const spx_float_t MIN_LEAK = {20972, -22};
97*28e138c6SAndroid Build Coastguard Worker
98*28e138c6SAndroid Build Coastguard Worker /* Constants for the two-path filter */
99*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR1_SMOOTH = {23593, -16};
100*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR2_SMOOTH = {23675, -15};
101*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR1_UPDATE = {16384, -15};
102*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR2_UPDATE = {16384, -16};
103*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR_BACKTRACK = {16384, -12};
104*28e138c6SAndroid Build Coastguard Worker #define TOP16(x) ((x)>>16)
105*28e138c6SAndroid Build Coastguard Worker
106*28e138c6SAndroid Build Coastguard Worker #else
107*28e138c6SAndroid Build Coastguard Worker
108*28e138c6SAndroid Build Coastguard Worker static const spx_float_t MIN_LEAK = .005f;
109*28e138c6SAndroid Build Coastguard Worker
110*28e138c6SAndroid Build Coastguard Worker /* Constants for the two-path filter */
111*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR1_SMOOTH = .36f;
112*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR2_SMOOTH = .7225f;
113*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR1_UPDATE = .5f;
114*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR2_UPDATE = .25f;
115*28e138c6SAndroid Build Coastguard Worker static const spx_float_t VAR_BACKTRACK = 4.f;
116*28e138c6SAndroid Build Coastguard Worker #define TOP16(x) (x)
117*28e138c6SAndroid Build Coastguard Worker #endif
118*28e138c6SAndroid Build Coastguard Worker
119*28e138c6SAndroid Build Coastguard Worker
120*28e138c6SAndroid Build Coastguard Worker #define PLAYBACK_DELAY 2
121*28e138c6SAndroid Build Coastguard Worker
122*28e138c6SAndroid Build Coastguard Worker void speex_echo_get_residual(SpeexEchoState *st, spx_word32_t *Yout, int len);
123*28e138c6SAndroid Build Coastguard Worker
124*28e138c6SAndroid Build Coastguard Worker
125*28e138c6SAndroid Build Coastguard Worker /** Speex echo cancellation state. */
126*28e138c6SAndroid Build Coastguard Worker struct SpeexEchoState_ {
127*28e138c6SAndroid Build Coastguard Worker int frame_size; /**< Number of samples processed each time */
128*28e138c6SAndroid Build Coastguard Worker int window_size;
129*28e138c6SAndroid Build Coastguard Worker int M;
130*28e138c6SAndroid Build Coastguard Worker int cancel_count;
131*28e138c6SAndroid Build Coastguard Worker int adapted;
132*28e138c6SAndroid Build Coastguard Worker int saturated;
133*28e138c6SAndroid Build Coastguard Worker int screwed_up;
134*28e138c6SAndroid Build Coastguard Worker int C; /** Number of input channels (microphones) */
135*28e138c6SAndroid Build Coastguard Worker int K; /** Number of output channels (loudspeakers) */
136*28e138c6SAndroid Build Coastguard Worker spx_int32_t sampling_rate;
137*28e138c6SAndroid Build Coastguard Worker spx_word16_t spec_average;
138*28e138c6SAndroid Build Coastguard Worker spx_word16_t beta0;
139*28e138c6SAndroid Build Coastguard Worker spx_word16_t beta_max;
140*28e138c6SAndroid Build Coastguard Worker spx_word32_t sum_adapt;
141*28e138c6SAndroid Build Coastguard Worker spx_word16_t leak_estimate;
142*28e138c6SAndroid Build Coastguard Worker
143*28e138c6SAndroid Build Coastguard Worker spx_word16_t *e; /* scratch */
144*28e138c6SAndroid Build Coastguard Worker spx_word16_t *x; /* Far-end input buffer (2N) */
145*28e138c6SAndroid Build Coastguard Worker spx_word16_t *X; /* Far-end buffer (M+1 frames) in frequency domain */
146*28e138c6SAndroid Build Coastguard Worker spx_word16_t *input; /* scratch */
147*28e138c6SAndroid Build Coastguard Worker spx_word16_t *y; /* scratch */
148*28e138c6SAndroid Build Coastguard Worker spx_word16_t *last_y;
149*28e138c6SAndroid Build Coastguard Worker spx_word16_t *Y; /* scratch */
150*28e138c6SAndroid Build Coastguard Worker spx_word16_t *E;
151*28e138c6SAndroid Build Coastguard Worker spx_word32_t *PHI; /* scratch */
152*28e138c6SAndroid Build Coastguard Worker spx_word32_t *W; /* (Background) filter weights */
153*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
154*28e138c6SAndroid Build Coastguard Worker spx_word16_t *foreground; /* Foreground filter weights */
155*28e138c6SAndroid Build Coastguard Worker spx_word32_t Davg1; /* 1st recursive average of the residual power difference */
156*28e138c6SAndroid Build Coastguard Worker spx_word32_t Davg2; /* 2nd recursive average of the residual power difference */
157*28e138c6SAndroid Build Coastguard Worker spx_float_t Dvar1; /* Estimated variance of 1st estimator */
158*28e138c6SAndroid Build Coastguard Worker spx_float_t Dvar2; /* Estimated variance of 2nd estimator */
159*28e138c6SAndroid Build Coastguard Worker #endif
160*28e138c6SAndroid Build Coastguard Worker spx_word32_t *power; /* Power of the far-end signal */
161*28e138c6SAndroid Build Coastguard Worker spx_float_t *power_1;/* Inverse power of far-end */
162*28e138c6SAndroid Build Coastguard Worker spx_word16_t *wtmp; /* scratch */
163*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
164*28e138c6SAndroid Build Coastguard Worker spx_word16_t *wtmp2; /* scratch */
165*28e138c6SAndroid Build Coastguard Worker #endif
166*28e138c6SAndroid Build Coastguard Worker spx_word32_t *Rf; /* scratch */
167*28e138c6SAndroid Build Coastguard Worker spx_word32_t *Yf; /* scratch */
168*28e138c6SAndroid Build Coastguard Worker spx_word32_t *Xf; /* scratch */
169*28e138c6SAndroid Build Coastguard Worker spx_word32_t *Eh;
170*28e138c6SAndroid Build Coastguard Worker spx_word32_t *Yh;
171*28e138c6SAndroid Build Coastguard Worker spx_float_t Pey;
172*28e138c6SAndroid Build Coastguard Worker spx_float_t Pyy;
173*28e138c6SAndroid Build Coastguard Worker spx_word16_t *window;
174*28e138c6SAndroid Build Coastguard Worker spx_word16_t *prop;
175*28e138c6SAndroid Build Coastguard Worker void *fft_table;
176*28e138c6SAndroid Build Coastguard Worker spx_word16_t *memX, *memD, *memE;
177*28e138c6SAndroid Build Coastguard Worker spx_word16_t preemph;
178*28e138c6SAndroid Build Coastguard Worker spx_word16_t notch_radius;
179*28e138c6SAndroid Build Coastguard Worker spx_mem_t *notch_mem;
180*28e138c6SAndroid Build Coastguard Worker
181*28e138c6SAndroid Build Coastguard Worker /* NOTE: If you only use speex_echo_cancel() and want to save some memory, remove this */
182*28e138c6SAndroid Build Coastguard Worker spx_int16_t *play_buf;
183*28e138c6SAndroid Build Coastguard Worker int play_buf_pos;
184*28e138c6SAndroid Build Coastguard Worker int play_buf_started;
185*28e138c6SAndroid Build Coastguard Worker };
186*28e138c6SAndroid Build Coastguard Worker
filter_dc_notch16(const spx_int16_t * in,spx_word16_t radius,spx_word16_t * out,int len,spx_mem_t * mem,int stride)187*28e138c6SAndroid Build Coastguard Worker static inline void filter_dc_notch16(const spx_int16_t *in, spx_word16_t radius, spx_word16_t *out, int len, spx_mem_t *mem, int stride)
188*28e138c6SAndroid Build Coastguard Worker {
189*28e138c6SAndroid Build Coastguard Worker int i;
190*28e138c6SAndroid Build Coastguard Worker spx_word16_t den2;
191*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
192*28e138c6SAndroid Build Coastguard Worker den2 = MULT16_16_Q15(radius,radius) + MULT16_16_Q15(QCONST16(.7,15),MULT16_16_Q15(32767-radius,32767-radius));
193*28e138c6SAndroid Build Coastguard Worker #else
194*28e138c6SAndroid Build Coastguard Worker den2 = radius*radius + .7*(1-radius)*(1-radius);
195*28e138c6SAndroid Build Coastguard Worker #endif
196*28e138c6SAndroid Build Coastguard Worker /*printf ("%d %d %d %d %d %d\n", num[0], num[1], num[2], den[0], den[1], den[2]);*/
197*28e138c6SAndroid Build Coastguard Worker for (i=0;i<len;i++)
198*28e138c6SAndroid Build Coastguard Worker {
199*28e138c6SAndroid Build Coastguard Worker spx_word16_t vin = in[i*stride];
200*28e138c6SAndroid Build Coastguard Worker spx_word32_t vout = mem[0] + SHL32(EXTEND32(vin),15);
201*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
202*28e138c6SAndroid Build Coastguard Worker mem[0] = mem[1] + SHL32(SHL32(-EXTEND32(vin),15) + MULT16_32_Q15(radius,vout),1);
203*28e138c6SAndroid Build Coastguard Worker #else
204*28e138c6SAndroid Build Coastguard Worker mem[0] = mem[1] + 2*(-vin + radius*vout);
205*28e138c6SAndroid Build Coastguard Worker #endif
206*28e138c6SAndroid Build Coastguard Worker mem[1] = SHL32(EXTEND32(vin),15) - MULT16_32_Q15(den2,vout);
207*28e138c6SAndroid Build Coastguard Worker out[i] = SATURATE32(PSHR32(MULT16_32_Q15(radius,vout),15),32767);
208*28e138c6SAndroid Build Coastguard Worker }
209*28e138c6SAndroid Build Coastguard Worker }
210*28e138c6SAndroid Build Coastguard Worker
211*28e138c6SAndroid Build Coastguard Worker /* This inner product is slightly different from the codec version because of fixed-point */
mdf_inner_prod(const spx_word16_t * x,const spx_word16_t * y,int len)212*28e138c6SAndroid Build Coastguard Worker static inline spx_word32_t mdf_inner_prod(const spx_word16_t *x, const spx_word16_t *y, int len)
213*28e138c6SAndroid Build Coastguard Worker {
214*28e138c6SAndroid Build Coastguard Worker spx_word32_t sum=0;
215*28e138c6SAndroid Build Coastguard Worker len >>= 1;
216*28e138c6SAndroid Build Coastguard Worker while(len--)
217*28e138c6SAndroid Build Coastguard Worker {
218*28e138c6SAndroid Build Coastguard Worker spx_word32_t part=0;
219*28e138c6SAndroid Build Coastguard Worker part = MAC16_16(part,*x++,*y++);
220*28e138c6SAndroid Build Coastguard Worker part = MAC16_16(part,*x++,*y++);
221*28e138c6SAndroid Build Coastguard Worker /* HINT: If you had a 40-bit accumulator, you could shift only at the end */
222*28e138c6SAndroid Build Coastguard Worker sum = ADD32(sum,SHR32(part,6));
223*28e138c6SAndroid Build Coastguard Worker }
224*28e138c6SAndroid Build Coastguard Worker return sum;
225*28e138c6SAndroid Build Coastguard Worker }
226*28e138c6SAndroid Build Coastguard Worker
227*28e138c6SAndroid Build Coastguard Worker /** Compute power spectrum of a half-complex (packed) vector */
power_spectrum(const spx_word16_t * X,spx_word32_t * ps,int N)228*28e138c6SAndroid Build Coastguard Worker static inline void power_spectrum(const spx_word16_t *X, spx_word32_t *ps, int N)
229*28e138c6SAndroid Build Coastguard Worker {
230*28e138c6SAndroid Build Coastguard Worker int i, j;
231*28e138c6SAndroid Build Coastguard Worker ps[0]=MULT16_16(X[0],X[0]);
232*28e138c6SAndroid Build Coastguard Worker for (i=1,j=1;i<N-1;i+=2,j++)
233*28e138c6SAndroid Build Coastguard Worker {
234*28e138c6SAndroid Build Coastguard Worker ps[j] = MULT16_16(X[i],X[i]) + MULT16_16(X[i+1],X[i+1]);
235*28e138c6SAndroid Build Coastguard Worker }
236*28e138c6SAndroid Build Coastguard Worker ps[j]=MULT16_16(X[i],X[i]);
237*28e138c6SAndroid Build Coastguard Worker }
238*28e138c6SAndroid Build Coastguard Worker
239*28e138c6SAndroid Build Coastguard Worker /** Compute power spectrum of a half-complex (packed) vector and accumulate */
power_spectrum_accum(const spx_word16_t * X,spx_word32_t * ps,int N)240*28e138c6SAndroid Build Coastguard Worker static inline void power_spectrum_accum(const spx_word16_t *X, spx_word32_t *ps, int N)
241*28e138c6SAndroid Build Coastguard Worker {
242*28e138c6SAndroid Build Coastguard Worker int i, j;
243*28e138c6SAndroid Build Coastguard Worker ps[0]+=MULT16_16(X[0],X[0]);
244*28e138c6SAndroid Build Coastguard Worker for (i=1,j=1;i<N-1;i+=2,j++)
245*28e138c6SAndroid Build Coastguard Worker {
246*28e138c6SAndroid Build Coastguard Worker ps[j] += MULT16_16(X[i],X[i]) + MULT16_16(X[i+1],X[i+1]);
247*28e138c6SAndroid Build Coastguard Worker }
248*28e138c6SAndroid Build Coastguard Worker ps[j]+=MULT16_16(X[i],X[i]);
249*28e138c6SAndroid Build Coastguard Worker }
250*28e138c6SAndroid Build Coastguard Worker
251*28e138c6SAndroid Build Coastguard Worker /** Compute cross-power spectrum of a half-complex (packed) vectors and add to acc */
252*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
spectral_mul_accum(const spx_word16_t * X,const spx_word32_t * Y,spx_word16_t * acc,int N,int M)253*28e138c6SAndroid Build Coastguard Worker static inline void spectral_mul_accum(const spx_word16_t *X, const spx_word32_t *Y, spx_word16_t *acc, int N, int M)
254*28e138c6SAndroid Build Coastguard Worker {
255*28e138c6SAndroid Build Coastguard Worker int i,j;
256*28e138c6SAndroid Build Coastguard Worker spx_word32_t tmp1=0,tmp2=0;
257*28e138c6SAndroid Build Coastguard Worker for (j=0;j<M;j++)
258*28e138c6SAndroid Build Coastguard Worker {
259*28e138c6SAndroid Build Coastguard Worker tmp1 = MAC16_16(tmp1, X[j*N],TOP16(Y[j*N]));
260*28e138c6SAndroid Build Coastguard Worker }
261*28e138c6SAndroid Build Coastguard Worker acc[0] = PSHR32(tmp1,WEIGHT_SHIFT);
262*28e138c6SAndroid Build Coastguard Worker for (i=1;i<N-1;i+=2)
263*28e138c6SAndroid Build Coastguard Worker {
264*28e138c6SAndroid Build Coastguard Worker tmp1 = tmp2 = 0;
265*28e138c6SAndroid Build Coastguard Worker for (j=0;j<M;j++)
266*28e138c6SAndroid Build Coastguard Worker {
267*28e138c6SAndroid Build Coastguard Worker tmp1 = SUB32(MAC16_16(tmp1, X[j*N+i],TOP16(Y[j*N+i])), MULT16_16(X[j*N+i+1],TOP16(Y[j*N+i+1])));
268*28e138c6SAndroid Build Coastguard Worker tmp2 = MAC16_16(MAC16_16(tmp2, X[j*N+i+1],TOP16(Y[j*N+i])), X[j*N+i], TOP16(Y[j*N+i+1]));
269*28e138c6SAndroid Build Coastguard Worker }
270*28e138c6SAndroid Build Coastguard Worker acc[i] = PSHR32(tmp1,WEIGHT_SHIFT);
271*28e138c6SAndroid Build Coastguard Worker acc[i+1] = PSHR32(tmp2,WEIGHT_SHIFT);
272*28e138c6SAndroid Build Coastguard Worker }
273*28e138c6SAndroid Build Coastguard Worker tmp1 = tmp2 = 0;
274*28e138c6SAndroid Build Coastguard Worker for (j=0;j<M;j++)
275*28e138c6SAndroid Build Coastguard Worker {
276*28e138c6SAndroid Build Coastguard Worker tmp1 = MAC16_16(tmp1, X[(j+1)*N-1],TOP16(Y[(j+1)*N-1]));
277*28e138c6SAndroid Build Coastguard Worker }
278*28e138c6SAndroid Build Coastguard Worker acc[N-1] = PSHR32(tmp1,WEIGHT_SHIFT);
279*28e138c6SAndroid Build Coastguard Worker }
spectral_mul_accum16(const spx_word16_t * X,const spx_word16_t * Y,spx_word16_t * acc,int N,int M)280*28e138c6SAndroid Build Coastguard Worker static inline void spectral_mul_accum16(const spx_word16_t *X, const spx_word16_t *Y, spx_word16_t *acc, int N, int M)
281*28e138c6SAndroid Build Coastguard Worker {
282*28e138c6SAndroid Build Coastguard Worker int i,j;
283*28e138c6SAndroid Build Coastguard Worker spx_word32_t tmp1=0,tmp2=0;
284*28e138c6SAndroid Build Coastguard Worker for (j=0;j<M;j++)
285*28e138c6SAndroid Build Coastguard Worker {
286*28e138c6SAndroid Build Coastguard Worker tmp1 = MAC16_16(tmp1, X[j*N],Y[j*N]);
287*28e138c6SAndroid Build Coastguard Worker }
288*28e138c6SAndroid Build Coastguard Worker acc[0] = PSHR32(tmp1,WEIGHT_SHIFT);
289*28e138c6SAndroid Build Coastguard Worker for (i=1;i<N-1;i+=2)
290*28e138c6SAndroid Build Coastguard Worker {
291*28e138c6SAndroid Build Coastguard Worker tmp1 = tmp2 = 0;
292*28e138c6SAndroid Build Coastguard Worker for (j=0;j<M;j++)
293*28e138c6SAndroid Build Coastguard Worker {
294*28e138c6SAndroid Build Coastguard Worker tmp1 = SUB32(MAC16_16(tmp1, X[j*N+i],Y[j*N+i]), MULT16_16(X[j*N+i+1],Y[j*N+i+1]));
295*28e138c6SAndroid Build Coastguard Worker tmp2 = MAC16_16(MAC16_16(tmp2, X[j*N+i+1],Y[j*N+i]), X[j*N+i], Y[j*N+i+1]);
296*28e138c6SAndroid Build Coastguard Worker }
297*28e138c6SAndroid Build Coastguard Worker acc[i] = PSHR32(tmp1,WEIGHT_SHIFT);
298*28e138c6SAndroid Build Coastguard Worker acc[i+1] = PSHR32(tmp2,WEIGHT_SHIFT);
299*28e138c6SAndroid Build Coastguard Worker }
300*28e138c6SAndroid Build Coastguard Worker tmp1 = tmp2 = 0;
301*28e138c6SAndroid Build Coastguard Worker for (j=0;j<M;j++)
302*28e138c6SAndroid Build Coastguard Worker {
303*28e138c6SAndroid Build Coastguard Worker tmp1 = MAC16_16(tmp1, X[(j+1)*N-1],Y[(j+1)*N-1]);
304*28e138c6SAndroid Build Coastguard Worker }
305*28e138c6SAndroid Build Coastguard Worker acc[N-1] = PSHR32(tmp1,WEIGHT_SHIFT);
306*28e138c6SAndroid Build Coastguard Worker }
307*28e138c6SAndroid Build Coastguard Worker
308*28e138c6SAndroid Build Coastguard Worker #else
spectral_mul_accum(const spx_word16_t * X,const spx_word32_t * Y,spx_word16_t * acc,int N,int M)309*28e138c6SAndroid Build Coastguard Worker static inline void spectral_mul_accum(const spx_word16_t *X, const spx_word32_t *Y, spx_word16_t *acc, int N, int M)
310*28e138c6SAndroid Build Coastguard Worker {
311*28e138c6SAndroid Build Coastguard Worker int i,j;
312*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N;i++)
313*28e138c6SAndroid Build Coastguard Worker acc[i] = 0;
314*28e138c6SAndroid Build Coastguard Worker for (j=0;j<M;j++)
315*28e138c6SAndroid Build Coastguard Worker {
316*28e138c6SAndroid Build Coastguard Worker acc[0] += X[0]*Y[0];
317*28e138c6SAndroid Build Coastguard Worker for (i=1;i<N-1;i+=2)
318*28e138c6SAndroid Build Coastguard Worker {
319*28e138c6SAndroid Build Coastguard Worker acc[i] += (X[i]*Y[i] - X[i+1]*Y[i+1]);
320*28e138c6SAndroid Build Coastguard Worker acc[i+1] += (X[i+1]*Y[i] + X[i]*Y[i+1]);
321*28e138c6SAndroid Build Coastguard Worker }
322*28e138c6SAndroid Build Coastguard Worker acc[i] += X[i]*Y[i];
323*28e138c6SAndroid Build Coastguard Worker X += N;
324*28e138c6SAndroid Build Coastguard Worker Y += N;
325*28e138c6SAndroid Build Coastguard Worker }
326*28e138c6SAndroid Build Coastguard Worker }
327*28e138c6SAndroid Build Coastguard Worker #define spectral_mul_accum16 spectral_mul_accum
328*28e138c6SAndroid Build Coastguard Worker #endif
329*28e138c6SAndroid Build Coastguard Worker
330*28e138c6SAndroid Build Coastguard Worker /** Compute weighted cross-power spectrum of a half-complex (packed) vector with conjugate */
weighted_spectral_mul_conj(const spx_float_t * w,const spx_float_t p,const spx_word16_t * X,const spx_word16_t * Y,spx_word32_t * prod,int N)331*28e138c6SAndroid Build Coastguard Worker static inline void weighted_spectral_mul_conj(const spx_float_t *w, const spx_float_t p, const spx_word16_t *X, const spx_word16_t *Y, spx_word32_t *prod, int N)
332*28e138c6SAndroid Build Coastguard Worker {
333*28e138c6SAndroid Build Coastguard Worker int i, j;
334*28e138c6SAndroid Build Coastguard Worker spx_float_t W;
335*28e138c6SAndroid Build Coastguard Worker W = FLOAT_AMULT(p, w[0]);
336*28e138c6SAndroid Build Coastguard Worker prod[0] = FLOAT_MUL32(W,MULT16_16(X[0],Y[0]));
337*28e138c6SAndroid Build Coastguard Worker for (i=1,j=1;i<N-1;i+=2,j++)
338*28e138c6SAndroid Build Coastguard Worker {
339*28e138c6SAndroid Build Coastguard Worker W = FLOAT_AMULT(p, w[j]);
340*28e138c6SAndroid Build Coastguard Worker prod[i] = FLOAT_MUL32(W,MAC16_16(MULT16_16(X[i],Y[i]), X[i+1],Y[i+1]));
341*28e138c6SAndroid Build Coastguard Worker prod[i+1] = FLOAT_MUL32(W,MAC16_16(MULT16_16(-X[i+1],Y[i]), X[i],Y[i+1]));
342*28e138c6SAndroid Build Coastguard Worker }
343*28e138c6SAndroid Build Coastguard Worker W = FLOAT_AMULT(p, w[j]);
344*28e138c6SAndroid Build Coastguard Worker prod[i] = FLOAT_MUL32(W,MULT16_16(X[i],Y[i]));
345*28e138c6SAndroid Build Coastguard Worker }
346*28e138c6SAndroid Build Coastguard Worker
mdf_adjust_prop(const spx_word32_t * W,int N,int M,int P,spx_word16_t * prop)347*28e138c6SAndroid Build Coastguard Worker static inline void mdf_adjust_prop(const spx_word32_t *W, int N, int M, int P, spx_word16_t *prop)
348*28e138c6SAndroid Build Coastguard Worker {
349*28e138c6SAndroid Build Coastguard Worker int i, j, p;
350*28e138c6SAndroid Build Coastguard Worker spx_word16_t max_sum = 1;
351*28e138c6SAndroid Build Coastguard Worker spx_word32_t prop_sum = 1;
352*28e138c6SAndroid Build Coastguard Worker for (i=0;i<M;i++)
353*28e138c6SAndroid Build Coastguard Worker {
354*28e138c6SAndroid Build Coastguard Worker spx_word32_t tmp = 1;
355*28e138c6SAndroid Build Coastguard Worker for (p=0;p<P;p++)
356*28e138c6SAndroid Build Coastguard Worker for (j=0;j<N;j++)
357*28e138c6SAndroid Build Coastguard Worker tmp += MULT16_16(EXTRACT16(SHR32(W[p*N*M + i*N+j],18)), EXTRACT16(SHR32(W[p*N*M + i*N+j],18)));
358*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
359*28e138c6SAndroid Build Coastguard Worker /* Just a security in case an overflow were to occur */
360*28e138c6SAndroid Build Coastguard Worker tmp = MIN32(ABS32(tmp), 536870912);
361*28e138c6SAndroid Build Coastguard Worker #endif
362*28e138c6SAndroid Build Coastguard Worker prop[i] = spx_sqrt(tmp);
363*28e138c6SAndroid Build Coastguard Worker if (prop[i] > max_sum)
364*28e138c6SAndroid Build Coastguard Worker max_sum = prop[i];
365*28e138c6SAndroid Build Coastguard Worker }
366*28e138c6SAndroid Build Coastguard Worker for (i=0;i<M;i++)
367*28e138c6SAndroid Build Coastguard Worker {
368*28e138c6SAndroid Build Coastguard Worker prop[i] += MULT16_16_Q15(QCONST16(.1f,15),max_sum);
369*28e138c6SAndroid Build Coastguard Worker prop_sum += EXTEND32(prop[i]);
370*28e138c6SAndroid Build Coastguard Worker }
371*28e138c6SAndroid Build Coastguard Worker for (i=0;i<M;i++)
372*28e138c6SAndroid Build Coastguard Worker {
373*28e138c6SAndroid Build Coastguard Worker prop[i] = DIV32(MULT16_16(QCONST16(.99f,15), prop[i]),prop_sum);
374*28e138c6SAndroid Build Coastguard Worker /*printf ("%f ", prop[i]);*/
375*28e138c6SAndroid Build Coastguard Worker }
376*28e138c6SAndroid Build Coastguard Worker /*printf ("\n");*/
377*28e138c6SAndroid Build Coastguard Worker }
378*28e138c6SAndroid Build Coastguard Worker
379*28e138c6SAndroid Build Coastguard Worker #ifdef DUMP_ECHO_CANCEL_DATA
380*28e138c6SAndroid Build Coastguard Worker #include <stdio.h>
381*28e138c6SAndroid Build Coastguard Worker static FILE *rFile=NULL, *pFile=NULL, *oFile=NULL;
382*28e138c6SAndroid Build Coastguard Worker
dump_audio(const spx_int16_t * rec,const spx_int16_t * play,const spx_int16_t * out,int len)383*28e138c6SAndroid Build Coastguard Worker static void dump_audio(const spx_int16_t *rec, const spx_int16_t *play, const spx_int16_t *out, int len)
384*28e138c6SAndroid Build Coastguard Worker {
385*28e138c6SAndroid Build Coastguard Worker if (!(rFile && pFile && oFile))
386*28e138c6SAndroid Build Coastguard Worker {
387*28e138c6SAndroid Build Coastguard Worker speex_fatal("Dump files not open");
388*28e138c6SAndroid Build Coastguard Worker }
389*28e138c6SAndroid Build Coastguard Worker fwrite(rec, sizeof(spx_int16_t), len, rFile);
390*28e138c6SAndroid Build Coastguard Worker fwrite(play, sizeof(spx_int16_t), len, pFile);
391*28e138c6SAndroid Build Coastguard Worker fwrite(out, sizeof(spx_int16_t), len, oFile);
392*28e138c6SAndroid Build Coastguard Worker }
393*28e138c6SAndroid Build Coastguard Worker #endif
394*28e138c6SAndroid Build Coastguard Worker
395*28e138c6SAndroid Build Coastguard Worker /** Creates a new echo canceller state */
speex_echo_state_init(int frame_size,int filter_length)396*28e138c6SAndroid Build Coastguard Worker EXPORT SpeexEchoState *speex_echo_state_init(int frame_size, int filter_length)
397*28e138c6SAndroid Build Coastguard Worker {
398*28e138c6SAndroid Build Coastguard Worker return speex_echo_state_init_mc(frame_size, filter_length, 1, 1);
399*28e138c6SAndroid Build Coastguard Worker }
400*28e138c6SAndroid Build Coastguard Worker
speex_echo_state_init_mc(int frame_size,int filter_length,int nb_mic,int nb_speakers)401*28e138c6SAndroid Build Coastguard Worker EXPORT SpeexEchoState *speex_echo_state_init_mc(int frame_size, int filter_length, int nb_mic, int nb_speakers)
402*28e138c6SAndroid Build Coastguard Worker {
403*28e138c6SAndroid Build Coastguard Worker int i,N,M, C, K;
404*28e138c6SAndroid Build Coastguard Worker SpeexEchoState *st = (SpeexEchoState *)speex_alloc(sizeof(SpeexEchoState));
405*28e138c6SAndroid Build Coastguard Worker
406*28e138c6SAndroid Build Coastguard Worker st->K = nb_speakers;
407*28e138c6SAndroid Build Coastguard Worker st->C = nb_mic;
408*28e138c6SAndroid Build Coastguard Worker C=st->C;
409*28e138c6SAndroid Build Coastguard Worker K=st->K;
410*28e138c6SAndroid Build Coastguard Worker #ifdef DUMP_ECHO_CANCEL_DATA
411*28e138c6SAndroid Build Coastguard Worker if (rFile || pFile || oFile)
412*28e138c6SAndroid Build Coastguard Worker speex_fatal("Opening dump files twice");
413*28e138c6SAndroid Build Coastguard Worker rFile = fopen("aec_rec.sw", "wb");
414*28e138c6SAndroid Build Coastguard Worker pFile = fopen("aec_play.sw", "wb");
415*28e138c6SAndroid Build Coastguard Worker oFile = fopen("aec_out.sw", "wb");
416*28e138c6SAndroid Build Coastguard Worker #endif
417*28e138c6SAndroid Build Coastguard Worker
418*28e138c6SAndroid Build Coastguard Worker st->frame_size = frame_size;
419*28e138c6SAndroid Build Coastguard Worker st->window_size = 2*frame_size;
420*28e138c6SAndroid Build Coastguard Worker N = st->window_size;
421*28e138c6SAndroid Build Coastguard Worker M = st->M = (filter_length+st->frame_size-1)/frame_size;
422*28e138c6SAndroid Build Coastguard Worker st->cancel_count=0;
423*28e138c6SAndroid Build Coastguard Worker st->sum_adapt = 0;
424*28e138c6SAndroid Build Coastguard Worker st->saturated = 0;
425*28e138c6SAndroid Build Coastguard Worker st->screwed_up = 0;
426*28e138c6SAndroid Build Coastguard Worker /* This is the default sampling rate */
427*28e138c6SAndroid Build Coastguard Worker st->sampling_rate = 8000;
428*28e138c6SAndroid Build Coastguard Worker st->spec_average = DIV32_16(SHL32(EXTEND32(st->frame_size), 15), st->sampling_rate);
429*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
430*28e138c6SAndroid Build Coastguard Worker st->beta0 = DIV32_16(SHL32(EXTEND32(st->frame_size), 16), st->sampling_rate);
431*28e138c6SAndroid Build Coastguard Worker st->beta_max = DIV32_16(SHL32(EXTEND32(st->frame_size), 14), st->sampling_rate);
432*28e138c6SAndroid Build Coastguard Worker #else
433*28e138c6SAndroid Build Coastguard Worker st->beta0 = (2.0f*st->frame_size)/st->sampling_rate;
434*28e138c6SAndroid Build Coastguard Worker st->beta_max = (.5f*st->frame_size)/st->sampling_rate;
435*28e138c6SAndroid Build Coastguard Worker #endif
436*28e138c6SAndroid Build Coastguard Worker st->leak_estimate = 0;
437*28e138c6SAndroid Build Coastguard Worker
438*28e138c6SAndroid Build Coastguard Worker st->fft_table = spx_fft_init(N);
439*28e138c6SAndroid Build Coastguard Worker
440*28e138c6SAndroid Build Coastguard Worker st->e = (spx_word16_t*)speex_alloc(C*N*sizeof(spx_word16_t));
441*28e138c6SAndroid Build Coastguard Worker st->x = (spx_word16_t*)speex_alloc(K*N*sizeof(spx_word16_t));
442*28e138c6SAndroid Build Coastguard Worker st->input = (spx_word16_t*)speex_alloc(C*st->frame_size*sizeof(spx_word16_t));
443*28e138c6SAndroid Build Coastguard Worker st->y = (spx_word16_t*)speex_alloc(C*N*sizeof(spx_word16_t));
444*28e138c6SAndroid Build Coastguard Worker st->last_y = (spx_word16_t*)speex_alloc(C*N*sizeof(spx_word16_t));
445*28e138c6SAndroid Build Coastguard Worker st->Yf = (spx_word32_t*)speex_alloc((st->frame_size+1)*sizeof(spx_word32_t));
446*28e138c6SAndroid Build Coastguard Worker st->Rf = (spx_word32_t*)speex_alloc((st->frame_size+1)*sizeof(spx_word32_t));
447*28e138c6SAndroid Build Coastguard Worker st->Xf = (spx_word32_t*)speex_alloc((st->frame_size+1)*sizeof(spx_word32_t));
448*28e138c6SAndroid Build Coastguard Worker st->Yh = (spx_word32_t*)speex_alloc((st->frame_size+1)*sizeof(spx_word32_t));
449*28e138c6SAndroid Build Coastguard Worker st->Eh = (spx_word32_t*)speex_alloc((st->frame_size+1)*sizeof(spx_word32_t));
450*28e138c6SAndroid Build Coastguard Worker
451*28e138c6SAndroid Build Coastguard Worker st->X = (spx_word16_t*)speex_alloc(K*(M+1)*N*sizeof(spx_word16_t));
452*28e138c6SAndroid Build Coastguard Worker st->Y = (spx_word16_t*)speex_alloc(C*N*sizeof(spx_word16_t));
453*28e138c6SAndroid Build Coastguard Worker st->E = (spx_word16_t*)speex_alloc(C*N*sizeof(spx_word16_t));
454*28e138c6SAndroid Build Coastguard Worker st->W = (spx_word32_t*)speex_alloc(C*K*M*N*sizeof(spx_word32_t));
455*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
456*28e138c6SAndroid Build Coastguard Worker st->foreground = (spx_word16_t*)speex_alloc(M*N*C*K*sizeof(spx_word16_t));
457*28e138c6SAndroid Build Coastguard Worker #endif
458*28e138c6SAndroid Build Coastguard Worker st->PHI = (spx_word32_t*)speex_alloc(N*sizeof(spx_word32_t));
459*28e138c6SAndroid Build Coastguard Worker st->power = (spx_word32_t*)speex_alloc((frame_size+1)*sizeof(spx_word32_t));
460*28e138c6SAndroid Build Coastguard Worker st->power_1 = (spx_float_t*)speex_alloc((frame_size+1)*sizeof(spx_float_t));
461*28e138c6SAndroid Build Coastguard Worker st->window = (spx_word16_t*)speex_alloc(N*sizeof(spx_word16_t));
462*28e138c6SAndroid Build Coastguard Worker st->prop = (spx_word16_t*)speex_alloc(M*sizeof(spx_word16_t));
463*28e138c6SAndroid Build Coastguard Worker st->wtmp = (spx_word16_t*)speex_alloc(N*sizeof(spx_word16_t));
464*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
465*28e138c6SAndroid Build Coastguard Worker st->wtmp2 = (spx_word16_t*)speex_alloc(N*sizeof(spx_word16_t));
466*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N>>1;i++)
467*28e138c6SAndroid Build Coastguard Worker {
468*28e138c6SAndroid Build Coastguard Worker st->window[i] = (16383-SHL16(spx_cos(DIV32_16(MULT16_16(25736,i<<1),N)),1));
469*28e138c6SAndroid Build Coastguard Worker st->window[N-i-1] = st->window[i];
470*28e138c6SAndroid Build Coastguard Worker }
471*28e138c6SAndroid Build Coastguard Worker #else
472*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N;i++)
473*28e138c6SAndroid Build Coastguard Worker st->window[i] = .5-.5*cos(2*M_PI*i/N);
474*28e138c6SAndroid Build Coastguard Worker #endif
475*28e138c6SAndroid Build Coastguard Worker for (i=0;i<=st->frame_size;i++)
476*28e138c6SAndroid Build Coastguard Worker st->power_1[i] = FLOAT_ONE;
477*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N*M*K*C;i++)
478*28e138c6SAndroid Build Coastguard Worker st->W[i] = 0;
479*28e138c6SAndroid Build Coastguard Worker {
480*28e138c6SAndroid Build Coastguard Worker spx_word32_t sum = 0;
481*28e138c6SAndroid Build Coastguard Worker /* Ratio of ~10 between adaptation rate of first and last block */
482*28e138c6SAndroid Build Coastguard Worker spx_word16_t decay = SHR32(spx_exp(NEG16(DIV32_16(QCONST16(2.4,11),M))),1);
483*28e138c6SAndroid Build Coastguard Worker st->prop[0] = QCONST16(.7, 15);
484*28e138c6SAndroid Build Coastguard Worker sum = EXTEND32(st->prop[0]);
485*28e138c6SAndroid Build Coastguard Worker for (i=1;i<M;i++)
486*28e138c6SAndroid Build Coastguard Worker {
487*28e138c6SAndroid Build Coastguard Worker st->prop[i] = MULT16_16_Q15(st->prop[i-1], decay);
488*28e138c6SAndroid Build Coastguard Worker sum = ADD32(sum, EXTEND32(st->prop[i]));
489*28e138c6SAndroid Build Coastguard Worker }
490*28e138c6SAndroid Build Coastguard Worker for (i=M-1;i>=0;i--)
491*28e138c6SAndroid Build Coastguard Worker {
492*28e138c6SAndroid Build Coastguard Worker st->prop[i] = DIV32(MULT16_16(QCONST16(.8f,15), st->prop[i]),sum);
493*28e138c6SAndroid Build Coastguard Worker }
494*28e138c6SAndroid Build Coastguard Worker }
495*28e138c6SAndroid Build Coastguard Worker
496*28e138c6SAndroid Build Coastguard Worker st->memX = (spx_word16_t*)speex_alloc(K*sizeof(spx_word16_t));
497*28e138c6SAndroid Build Coastguard Worker st->memD = (spx_word16_t*)speex_alloc(C*sizeof(spx_word16_t));
498*28e138c6SAndroid Build Coastguard Worker st->memE = (spx_word16_t*)speex_alloc(C*sizeof(spx_word16_t));
499*28e138c6SAndroid Build Coastguard Worker st->preemph = QCONST16(.9,15);
500*28e138c6SAndroid Build Coastguard Worker if (st->sampling_rate<12000)
501*28e138c6SAndroid Build Coastguard Worker st->notch_radius = QCONST16(.9, 15);
502*28e138c6SAndroid Build Coastguard Worker else if (st->sampling_rate<24000)
503*28e138c6SAndroid Build Coastguard Worker st->notch_radius = QCONST16(.982, 15);
504*28e138c6SAndroid Build Coastguard Worker else
505*28e138c6SAndroid Build Coastguard Worker st->notch_radius = QCONST16(.992, 15);
506*28e138c6SAndroid Build Coastguard Worker
507*28e138c6SAndroid Build Coastguard Worker st->notch_mem = (spx_mem_t*)speex_alloc(2*C*sizeof(spx_mem_t));
508*28e138c6SAndroid Build Coastguard Worker st->adapted = 0;
509*28e138c6SAndroid Build Coastguard Worker st->Pey = st->Pyy = FLOAT_ONE;
510*28e138c6SAndroid Build Coastguard Worker
511*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
512*28e138c6SAndroid Build Coastguard Worker st->Davg1 = st->Davg2 = 0;
513*28e138c6SAndroid Build Coastguard Worker st->Dvar1 = st->Dvar2 = FLOAT_ZERO;
514*28e138c6SAndroid Build Coastguard Worker #endif
515*28e138c6SAndroid Build Coastguard Worker
516*28e138c6SAndroid Build Coastguard Worker st->play_buf = (spx_int16_t*)speex_alloc(K*(PLAYBACK_DELAY+1)*st->frame_size*sizeof(spx_int16_t));
517*28e138c6SAndroid Build Coastguard Worker st->play_buf_pos = PLAYBACK_DELAY*st->frame_size;
518*28e138c6SAndroid Build Coastguard Worker st->play_buf_started = 0;
519*28e138c6SAndroid Build Coastguard Worker
520*28e138c6SAndroid Build Coastguard Worker return st;
521*28e138c6SAndroid Build Coastguard Worker }
522*28e138c6SAndroid Build Coastguard Worker
523*28e138c6SAndroid Build Coastguard Worker /** Resets echo canceller state */
speex_echo_state_reset(SpeexEchoState * st)524*28e138c6SAndroid Build Coastguard Worker EXPORT void speex_echo_state_reset(SpeexEchoState *st)
525*28e138c6SAndroid Build Coastguard Worker {
526*28e138c6SAndroid Build Coastguard Worker int i, M, N, C, K;
527*28e138c6SAndroid Build Coastguard Worker st->cancel_count=0;
528*28e138c6SAndroid Build Coastguard Worker st->screwed_up = 0;
529*28e138c6SAndroid Build Coastguard Worker N = st->window_size;
530*28e138c6SAndroid Build Coastguard Worker M = st->M;
531*28e138c6SAndroid Build Coastguard Worker C=st->C;
532*28e138c6SAndroid Build Coastguard Worker K=st->K;
533*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N*M;i++)
534*28e138c6SAndroid Build Coastguard Worker st->W[i] = 0;
535*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
536*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N*M;i++)
537*28e138c6SAndroid Build Coastguard Worker st->foreground[i] = 0;
538*28e138c6SAndroid Build Coastguard Worker #endif
539*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N*(M+1);i++)
540*28e138c6SAndroid Build Coastguard Worker st->X[i] = 0;
541*28e138c6SAndroid Build Coastguard Worker for (i=0;i<=st->frame_size;i++)
542*28e138c6SAndroid Build Coastguard Worker {
543*28e138c6SAndroid Build Coastguard Worker st->power[i] = 0;
544*28e138c6SAndroid Build Coastguard Worker st->power_1[i] = FLOAT_ONE;
545*28e138c6SAndroid Build Coastguard Worker st->Eh[i] = 0;
546*28e138c6SAndroid Build Coastguard Worker st->Yh[i] = 0;
547*28e138c6SAndroid Build Coastguard Worker }
548*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
549*28e138c6SAndroid Build Coastguard Worker {
550*28e138c6SAndroid Build Coastguard Worker st->last_y[i] = 0;
551*28e138c6SAndroid Build Coastguard Worker }
552*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N*C;i++)
553*28e138c6SAndroid Build Coastguard Worker {
554*28e138c6SAndroid Build Coastguard Worker st->E[i] = 0;
555*28e138c6SAndroid Build Coastguard Worker }
556*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N*K;i++)
557*28e138c6SAndroid Build Coastguard Worker {
558*28e138c6SAndroid Build Coastguard Worker st->x[i] = 0;
559*28e138c6SAndroid Build Coastguard Worker }
560*28e138c6SAndroid Build Coastguard Worker for (i=0;i<2*C;i++)
561*28e138c6SAndroid Build Coastguard Worker st->notch_mem[i] = 0;
562*28e138c6SAndroid Build Coastguard Worker for (i=0;i<C;i++)
563*28e138c6SAndroid Build Coastguard Worker st->memD[i]=st->memE[i]=0;
564*28e138c6SAndroid Build Coastguard Worker for (i=0;i<K;i++)
565*28e138c6SAndroid Build Coastguard Worker st->memX[i]=0;
566*28e138c6SAndroid Build Coastguard Worker
567*28e138c6SAndroid Build Coastguard Worker st->saturated = 0;
568*28e138c6SAndroid Build Coastguard Worker st->adapted = 0;
569*28e138c6SAndroid Build Coastguard Worker st->sum_adapt = 0;
570*28e138c6SAndroid Build Coastguard Worker st->Pey = st->Pyy = FLOAT_ONE;
571*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
572*28e138c6SAndroid Build Coastguard Worker st->Davg1 = st->Davg2 = 0;
573*28e138c6SAndroid Build Coastguard Worker st->Dvar1 = st->Dvar2 = FLOAT_ZERO;
574*28e138c6SAndroid Build Coastguard Worker #endif
575*28e138c6SAndroid Build Coastguard Worker for (i=0;i<3*st->frame_size;i++)
576*28e138c6SAndroid Build Coastguard Worker st->play_buf[i] = 0;
577*28e138c6SAndroid Build Coastguard Worker st->play_buf_pos = PLAYBACK_DELAY*st->frame_size;
578*28e138c6SAndroid Build Coastguard Worker st->play_buf_started = 0;
579*28e138c6SAndroid Build Coastguard Worker
580*28e138c6SAndroid Build Coastguard Worker }
581*28e138c6SAndroid Build Coastguard Worker
582*28e138c6SAndroid Build Coastguard Worker /** Destroys an echo canceller state */
speex_echo_state_destroy(SpeexEchoState * st)583*28e138c6SAndroid Build Coastguard Worker EXPORT void speex_echo_state_destroy(SpeexEchoState *st)
584*28e138c6SAndroid Build Coastguard Worker {
585*28e138c6SAndroid Build Coastguard Worker spx_fft_destroy(st->fft_table);
586*28e138c6SAndroid Build Coastguard Worker
587*28e138c6SAndroid Build Coastguard Worker speex_free(st->e);
588*28e138c6SAndroid Build Coastguard Worker speex_free(st->x);
589*28e138c6SAndroid Build Coastguard Worker speex_free(st->input);
590*28e138c6SAndroid Build Coastguard Worker speex_free(st->y);
591*28e138c6SAndroid Build Coastguard Worker speex_free(st->last_y);
592*28e138c6SAndroid Build Coastguard Worker speex_free(st->Yf);
593*28e138c6SAndroid Build Coastguard Worker speex_free(st->Rf);
594*28e138c6SAndroid Build Coastguard Worker speex_free(st->Xf);
595*28e138c6SAndroid Build Coastguard Worker speex_free(st->Yh);
596*28e138c6SAndroid Build Coastguard Worker speex_free(st->Eh);
597*28e138c6SAndroid Build Coastguard Worker
598*28e138c6SAndroid Build Coastguard Worker speex_free(st->X);
599*28e138c6SAndroid Build Coastguard Worker speex_free(st->Y);
600*28e138c6SAndroid Build Coastguard Worker speex_free(st->E);
601*28e138c6SAndroid Build Coastguard Worker speex_free(st->W);
602*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
603*28e138c6SAndroid Build Coastguard Worker speex_free(st->foreground);
604*28e138c6SAndroid Build Coastguard Worker #endif
605*28e138c6SAndroid Build Coastguard Worker speex_free(st->PHI);
606*28e138c6SAndroid Build Coastguard Worker speex_free(st->power);
607*28e138c6SAndroid Build Coastguard Worker speex_free(st->power_1);
608*28e138c6SAndroid Build Coastguard Worker speex_free(st->window);
609*28e138c6SAndroid Build Coastguard Worker speex_free(st->prop);
610*28e138c6SAndroid Build Coastguard Worker speex_free(st->wtmp);
611*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
612*28e138c6SAndroid Build Coastguard Worker speex_free(st->wtmp2);
613*28e138c6SAndroid Build Coastguard Worker #endif
614*28e138c6SAndroid Build Coastguard Worker speex_free(st->memX);
615*28e138c6SAndroid Build Coastguard Worker speex_free(st->memD);
616*28e138c6SAndroid Build Coastguard Worker speex_free(st->memE);
617*28e138c6SAndroid Build Coastguard Worker speex_free(st->notch_mem);
618*28e138c6SAndroid Build Coastguard Worker
619*28e138c6SAndroid Build Coastguard Worker speex_free(st->play_buf);
620*28e138c6SAndroid Build Coastguard Worker speex_free(st);
621*28e138c6SAndroid Build Coastguard Worker
622*28e138c6SAndroid Build Coastguard Worker #ifdef DUMP_ECHO_CANCEL_DATA
623*28e138c6SAndroid Build Coastguard Worker fclose(rFile);
624*28e138c6SAndroid Build Coastguard Worker fclose(pFile);
625*28e138c6SAndroid Build Coastguard Worker fclose(oFile);
626*28e138c6SAndroid Build Coastguard Worker rFile = pFile = oFile = NULL;
627*28e138c6SAndroid Build Coastguard Worker #endif
628*28e138c6SAndroid Build Coastguard Worker }
629*28e138c6SAndroid Build Coastguard Worker
speex_echo_capture(SpeexEchoState * st,const spx_int16_t * rec,spx_int16_t * out)630*28e138c6SAndroid Build Coastguard Worker EXPORT void speex_echo_capture(SpeexEchoState *st, const spx_int16_t *rec, spx_int16_t *out)
631*28e138c6SAndroid Build Coastguard Worker {
632*28e138c6SAndroid Build Coastguard Worker int i;
633*28e138c6SAndroid Build Coastguard Worker /*speex_warning_int("capture with fill level ", st->play_buf_pos/st->frame_size);*/
634*28e138c6SAndroid Build Coastguard Worker st->play_buf_started = 1;
635*28e138c6SAndroid Build Coastguard Worker if (st->play_buf_pos>=st->frame_size)
636*28e138c6SAndroid Build Coastguard Worker {
637*28e138c6SAndroid Build Coastguard Worker speex_echo_cancellation(st, rec, st->play_buf, out);
638*28e138c6SAndroid Build Coastguard Worker st->play_buf_pos -= st->frame_size;
639*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->play_buf_pos;i++)
640*28e138c6SAndroid Build Coastguard Worker st->play_buf[i] = st->play_buf[i+st->frame_size];
641*28e138c6SAndroid Build Coastguard Worker } else {
642*28e138c6SAndroid Build Coastguard Worker speex_warning("No playback frame available (your application is buggy and/or got xruns)");
643*28e138c6SAndroid Build Coastguard Worker if (st->play_buf_pos!=0)
644*28e138c6SAndroid Build Coastguard Worker {
645*28e138c6SAndroid Build Coastguard Worker speex_warning("internal playback buffer corruption?");
646*28e138c6SAndroid Build Coastguard Worker st->play_buf_pos = 0;
647*28e138c6SAndroid Build Coastguard Worker }
648*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
649*28e138c6SAndroid Build Coastguard Worker out[i] = rec[i];
650*28e138c6SAndroid Build Coastguard Worker }
651*28e138c6SAndroid Build Coastguard Worker }
652*28e138c6SAndroid Build Coastguard Worker
speex_echo_playback(SpeexEchoState * st,const spx_int16_t * play)653*28e138c6SAndroid Build Coastguard Worker EXPORT void speex_echo_playback(SpeexEchoState *st, const spx_int16_t *play)
654*28e138c6SAndroid Build Coastguard Worker {
655*28e138c6SAndroid Build Coastguard Worker /*speex_warning_int("playback with fill level ", st->play_buf_pos/st->frame_size);*/
656*28e138c6SAndroid Build Coastguard Worker if (!st->play_buf_started)
657*28e138c6SAndroid Build Coastguard Worker {
658*28e138c6SAndroid Build Coastguard Worker speex_warning("discarded first playback frame");
659*28e138c6SAndroid Build Coastguard Worker return;
660*28e138c6SAndroid Build Coastguard Worker }
661*28e138c6SAndroid Build Coastguard Worker if (st->play_buf_pos<=PLAYBACK_DELAY*st->frame_size)
662*28e138c6SAndroid Build Coastguard Worker {
663*28e138c6SAndroid Build Coastguard Worker int i;
664*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
665*28e138c6SAndroid Build Coastguard Worker st->play_buf[st->play_buf_pos+i] = play[i];
666*28e138c6SAndroid Build Coastguard Worker st->play_buf_pos += st->frame_size;
667*28e138c6SAndroid Build Coastguard Worker if (st->play_buf_pos <= (PLAYBACK_DELAY-1)*st->frame_size)
668*28e138c6SAndroid Build Coastguard Worker {
669*28e138c6SAndroid Build Coastguard Worker speex_warning("Auto-filling the buffer (your application is buggy and/or got xruns)");
670*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
671*28e138c6SAndroid Build Coastguard Worker st->play_buf[st->play_buf_pos+i] = play[i];
672*28e138c6SAndroid Build Coastguard Worker st->play_buf_pos += st->frame_size;
673*28e138c6SAndroid Build Coastguard Worker }
674*28e138c6SAndroid Build Coastguard Worker } else {
675*28e138c6SAndroid Build Coastguard Worker speex_warning("Had to discard a playback frame (your application is buggy and/or got xruns)");
676*28e138c6SAndroid Build Coastguard Worker }
677*28e138c6SAndroid Build Coastguard Worker }
678*28e138c6SAndroid Build Coastguard Worker
679*28e138c6SAndroid Build Coastguard Worker /** Performs echo cancellation on a frame (deprecated, last arg now ignored) */
speex_echo_cancel(SpeexEchoState * st,const spx_int16_t * in,const spx_int16_t * far_end,spx_int16_t * out,spx_int32_t * Yout)680*28e138c6SAndroid Build Coastguard Worker EXPORT void speex_echo_cancel(SpeexEchoState *st, const spx_int16_t *in, const spx_int16_t *far_end, spx_int16_t *out, spx_int32_t *Yout)
681*28e138c6SAndroid Build Coastguard Worker {
682*28e138c6SAndroid Build Coastguard Worker speex_echo_cancellation(st, in, far_end, out);
683*28e138c6SAndroid Build Coastguard Worker }
684*28e138c6SAndroid Build Coastguard Worker
685*28e138c6SAndroid Build Coastguard Worker /** Performs echo cancellation on a frame */
speex_echo_cancellation(SpeexEchoState * st,const spx_int16_t * in,const spx_int16_t * far_end,spx_int16_t * out)686*28e138c6SAndroid Build Coastguard Worker EXPORT void speex_echo_cancellation(SpeexEchoState *st, const spx_int16_t *in, const spx_int16_t *far_end, spx_int16_t *out)
687*28e138c6SAndroid Build Coastguard Worker {
688*28e138c6SAndroid Build Coastguard Worker int i,j, chan, speak;
689*28e138c6SAndroid Build Coastguard Worker int N,M, C, K;
690*28e138c6SAndroid Build Coastguard Worker spx_word32_t Syy,See,Sxx,Sdd, Sff;
691*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
692*28e138c6SAndroid Build Coastguard Worker spx_word32_t Dbf;
693*28e138c6SAndroid Build Coastguard Worker int update_foreground;
694*28e138c6SAndroid Build Coastguard Worker #endif
695*28e138c6SAndroid Build Coastguard Worker spx_word32_t Sey;
696*28e138c6SAndroid Build Coastguard Worker spx_word16_t ss, ss_1;
697*28e138c6SAndroid Build Coastguard Worker spx_float_t Pey = FLOAT_ONE, Pyy=FLOAT_ONE;
698*28e138c6SAndroid Build Coastguard Worker spx_float_t alpha, alpha_1;
699*28e138c6SAndroid Build Coastguard Worker spx_word16_t RER;
700*28e138c6SAndroid Build Coastguard Worker spx_word32_t tmp32;
701*28e138c6SAndroid Build Coastguard Worker
702*28e138c6SAndroid Build Coastguard Worker N = st->window_size;
703*28e138c6SAndroid Build Coastguard Worker M = st->M;
704*28e138c6SAndroid Build Coastguard Worker C = st->C;
705*28e138c6SAndroid Build Coastguard Worker K = st->K;
706*28e138c6SAndroid Build Coastguard Worker
707*28e138c6SAndroid Build Coastguard Worker st->cancel_count++;
708*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
709*28e138c6SAndroid Build Coastguard Worker ss=DIV32_16(11469,M);
710*28e138c6SAndroid Build Coastguard Worker ss_1 = SUB16(32767,ss);
711*28e138c6SAndroid Build Coastguard Worker #else
712*28e138c6SAndroid Build Coastguard Worker ss=.35/M;
713*28e138c6SAndroid Build Coastguard Worker ss_1 = 1-ss;
714*28e138c6SAndroid Build Coastguard Worker #endif
715*28e138c6SAndroid Build Coastguard Worker
716*28e138c6SAndroid Build Coastguard Worker for (chan = 0; chan < C; chan++)
717*28e138c6SAndroid Build Coastguard Worker {
718*28e138c6SAndroid Build Coastguard Worker /* Apply a notch filter to make sure DC doesn't end up causing problems */
719*28e138c6SAndroid Build Coastguard Worker filter_dc_notch16(in+chan, st->notch_radius, st->input+chan*st->frame_size, st->frame_size, st->notch_mem+2*chan, C);
720*28e138c6SAndroid Build Coastguard Worker /* Copy input data to buffer and apply pre-emphasis */
721*28e138c6SAndroid Build Coastguard Worker /* Copy input data to buffer */
722*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
723*28e138c6SAndroid Build Coastguard Worker {
724*28e138c6SAndroid Build Coastguard Worker spx_word32_t tmp32;
725*28e138c6SAndroid Build Coastguard Worker /* FIXME: This core has changed a bit, need to merge properly */
726*28e138c6SAndroid Build Coastguard Worker tmp32 = SUB32(EXTEND32(st->input[chan*st->frame_size+i]), EXTEND32(MULT16_16_P15(st->preemph, st->memD[chan])));
727*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
728*28e138c6SAndroid Build Coastguard Worker if (tmp32 > 32767)
729*28e138c6SAndroid Build Coastguard Worker {
730*28e138c6SAndroid Build Coastguard Worker tmp32 = 32767;
731*28e138c6SAndroid Build Coastguard Worker if (st->saturated == 0)
732*28e138c6SAndroid Build Coastguard Worker st->saturated = 1;
733*28e138c6SAndroid Build Coastguard Worker }
734*28e138c6SAndroid Build Coastguard Worker if (tmp32 < -32767)
735*28e138c6SAndroid Build Coastguard Worker {
736*28e138c6SAndroid Build Coastguard Worker tmp32 = -32767;
737*28e138c6SAndroid Build Coastguard Worker if (st->saturated == 0)
738*28e138c6SAndroid Build Coastguard Worker st->saturated = 1;
739*28e138c6SAndroid Build Coastguard Worker }
740*28e138c6SAndroid Build Coastguard Worker #endif
741*28e138c6SAndroid Build Coastguard Worker st->memD[chan] = st->input[chan*st->frame_size+i];
742*28e138c6SAndroid Build Coastguard Worker st->input[chan*st->frame_size+i] = EXTRACT16(tmp32);
743*28e138c6SAndroid Build Coastguard Worker }
744*28e138c6SAndroid Build Coastguard Worker }
745*28e138c6SAndroid Build Coastguard Worker
746*28e138c6SAndroid Build Coastguard Worker for (speak = 0; speak < K; speak++)
747*28e138c6SAndroid Build Coastguard Worker {
748*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
749*28e138c6SAndroid Build Coastguard Worker {
750*28e138c6SAndroid Build Coastguard Worker spx_word32_t tmp32;
751*28e138c6SAndroid Build Coastguard Worker st->x[speak*N+i] = st->x[speak*N+i+st->frame_size];
752*28e138c6SAndroid Build Coastguard Worker tmp32 = SUB32(EXTEND32(far_end[i*K+speak]), EXTEND32(MULT16_16_P15(st->preemph, st->memX[speak])));
753*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
754*28e138c6SAndroid Build Coastguard Worker /*FIXME: If saturation occurs here, we need to freeze adaptation for M frames (not just one) */
755*28e138c6SAndroid Build Coastguard Worker if (tmp32 > 32767)
756*28e138c6SAndroid Build Coastguard Worker {
757*28e138c6SAndroid Build Coastguard Worker tmp32 = 32767;
758*28e138c6SAndroid Build Coastguard Worker st->saturated = M+1;
759*28e138c6SAndroid Build Coastguard Worker }
760*28e138c6SAndroid Build Coastguard Worker if (tmp32 < -32767)
761*28e138c6SAndroid Build Coastguard Worker {
762*28e138c6SAndroid Build Coastguard Worker tmp32 = -32767;
763*28e138c6SAndroid Build Coastguard Worker st->saturated = M+1;
764*28e138c6SAndroid Build Coastguard Worker }
765*28e138c6SAndroid Build Coastguard Worker #endif
766*28e138c6SAndroid Build Coastguard Worker st->x[speak*N+i+st->frame_size] = EXTRACT16(tmp32);
767*28e138c6SAndroid Build Coastguard Worker st->memX[speak] = far_end[i*K+speak];
768*28e138c6SAndroid Build Coastguard Worker }
769*28e138c6SAndroid Build Coastguard Worker }
770*28e138c6SAndroid Build Coastguard Worker
771*28e138c6SAndroid Build Coastguard Worker for (speak = 0; speak < K; speak++)
772*28e138c6SAndroid Build Coastguard Worker {
773*28e138c6SAndroid Build Coastguard Worker /* Shift memory: this could be optimized eventually*/
774*28e138c6SAndroid Build Coastguard Worker for (j=M-1;j>=0;j--)
775*28e138c6SAndroid Build Coastguard Worker {
776*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N;i++)
777*28e138c6SAndroid Build Coastguard Worker st->X[(j+1)*N*K+speak*N+i] = st->X[j*N*K+speak*N+i];
778*28e138c6SAndroid Build Coastguard Worker }
779*28e138c6SAndroid Build Coastguard Worker /* Convert x (echo input) to frequency domain */
780*28e138c6SAndroid Build Coastguard Worker spx_fft(st->fft_table, st->x+speak*N, &st->X[speak*N]);
781*28e138c6SAndroid Build Coastguard Worker }
782*28e138c6SAndroid Build Coastguard Worker
783*28e138c6SAndroid Build Coastguard Worker Sxx = 0;
784*28e138c6SAndroid Build Coastguard Worker for (speak = 0; speak < K; speak++)
785*28e138c6SAndroid Build Coastguard Worker {
786*28e138c6SAndroid Build Coastguard Worker Sxx += mdf_inner_prod(st->x+speak*N+st->frame_size, st->x+speak*N+st->frame_size, st->frame_size);
787*28e138c6SAndroid Build Coastguard Worker power_spectrum_accum(st->X+speak*N, st->Xf, N);
788*28e138c6SAndroid Build Coastguard Worker }
789*28e138c6SAndroid Build Coastguard Worker
790*28e138c6SAndroid Build Coastguard Worker Sff = 0;
791*28e138c6SAndroid Build Coastguard Worker for (chan = 0; chan < C; chan++)
792*28e138c6SAndroid Build Coastguard Worker {
793*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
794*28e138c6SAndroid Build Coastguard Worker /* Compute foreground filter */
795*28e138c6SAndroid Build Coastguard Worker spectral_mul_accum16(st->X, st->foreground+chan*N*K*M, st->Y+chan*N, N, M*K);
796*28e138c6SAndroid Build Coastguard Worker spx_ifft(st->fft_table, st->Y+chan*N, st->e+chan*N);
797*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
798*28e138c6SAndroid Build Coastguard Worker st->e[chan*N+i] = SUB16(st->input[chan*st->frame_size+i], st->e[chan*N+i+st->frame_size]);
799*28e138c6SAndroid Build Coastguard Worker Sff += mdf_inner_prod(st->e+chan*N, st->e+chan*N, st->frame_size);
800*28e138c6SAndroid Build Coastguard Worker #endif
801*28e138c6SAndroid Build Coastguard Worker }
802*28e138c6SAndroid Build Coastguard Worker
803*28e138c6SAndroid Build Coastguard Worker /* Adjust proportional adaption rate */
804*28e138c6SAndroid Build Coastguard Worker /* FIXME: Adjust that for C, K*/
805*28e138c6SAndroid Build Coastguard Worker if (st->adapted)
806*28e138c6SAndroid Build Coastguard Worker mdf_adjust_prop (st->W, N, M, C*K, st->prop);
807*28e138c6SAndroid Build Coastguard Worker /* Compute weight gradient */
808*28e138c6SAndroid Build Coastguard Worker if (st->saturated == 0)
809*28e138c6SAndroid Build Coastguard Worker {
810*28e138c6SAndroid Build Coastguard Worker for (chan = 0; chan < C; chan++)
811*28e138c6SAndroid Build Coastguard Worker {
812*28e138c6SAndroid Build Coastguard Worker for (speak = 0; speak < K; speak++)
813*28e138c6SAndroid Build Coastguard Worker {
814*28e138c6SAndroid Build Coastguard Worker for (j=M-1;j>=0;j--)
815*28e138c6SAndroid Build Coastguard Worker {
816*28e138c6SAndroid Build Coastguard Worker weighted_spectral_mul_conj(st->power_1, FLOAT_SHL(PSEUDOFLOAT(st->prop[j]),-15), &st->X[(j+1)*N*K+speak*N], st->E+chan*N, st->PHI, N);
817*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N;i++)
818*28e138c6SAndroid Build Coastguard Worker st->W[chan*N*K*M + j*N*K + speak*N + i] += st->PHI[i];
819*28e138c6SAndroid Build Coastguard Worker }
820*28e138c6SAndroid Build Coastguard Worker }
821*28e138c6SAndroid Build Coastguard Worker }
822*28e138c6SAndroid Build Coastguard Worker } else {
823*28e138c6SAndroid Build Coastguard Worker st->saturated--;
824*28e138c6SAndroid Build Coastguard Worker }
825*28e138c6SAndroid Build Coastguard Worker
826*28e138c6SAndroid Build Coastguard Worker /* FIXME: MC conversion required */
827*28e138c6SAndroid Build Coastguard Worker /* Update weight to prevent circular convolution (MDF / AUMDF) */
828*28e138c6SAndroid Build Coastguard Worker for (chan = 0; chan < C; chan++)
829*28e138c6SAndroid Build Coastguard Worker {
830*28e138c6SAndroid Build Coastguard Worker for (speak = 0; speak < K; speak++)
831*28e138c6SAndroid Build Coastguard Worker {
832*28e138c6SAndroid Build Coastguard Worker for (j=0;j<M;j++)
833*28e138c6SAndroid Build Coastguard Worker {
834*28e138c6SAndroid Build Coastguard Worker /* This is a variant of the Alternatively Updated MDF (AUMDF) */
835*28e138c6SAndroid Build Coastguard Worker /* Remove the "if" to make this an MDF filter */
836*28e138c6SAndroid Build Coastguard Worker if (j==0 || st->cancel_count%(M-1) == j-1)
837*28e138c6SAndroid Build Coastguard Worker {
838*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
839*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N;i++)
840*28e138c6SAndroid Build Coastguard Worker st->wtmp2[i] = EXTRACT16(PSHR32(st->W[chan*N*K*M + j*N*K + speak*N + i],NORMALIZE_SCALEDOWN+16));
841*28e138c6SAndroid Build Coastguard Worker spx_ifft(st->fft_table, st->wtmp2, st->wtmp);
842*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
843*28e138c6SAndroid Build Coastguard Worker {
844*28e138c6SAndroid Build Coastguard Worker st->wtmp[i]=0;
845*28e138c6SAndroid Build Coastguard Worker }
846*28e138c6SAndroid Build Coastguard Worker for (i=st->frame_size;i<N;i++)
847*28e138c6SAndroid Build Coastguard Worker {
848*28e138c6SAndroid Build Coastguard Worker st->wtmp[i]=SHL16(st->wtmp[i],NORMALIZE_SCALEUP);
849*28e138c6SAndroid Build Coastguard Worker }
850*28e138c6SAndroid Build Coastguard Worker spx_fft(st->fft_table, st->wtmp, st->wtmp2);
851*28e138c6SAndroid Build Coastguard Worker /* The "-1" in the shift is a sort of kludge that trades less efficient update speed for decrease noise */
852*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N;i++)
853*28e138c6SAndroid Build Coastguard Worker st->W[chan*N*K*M + j*N*K + speak*N + i] -= SHL32(EXTEND32(st->wtmp2[i]),16+NORMALIZE_SCALEDOWN-NORMALIZE_SCALEUP-1);
854*28e138c6SAndroid Build Coastguard Worker #else
855*28e138c6SAndroid Build Coastguard Worker spx_ifft(st->fft_table, &st->W[chan*N*K*M + j*N*K + speak*N], st->wtmp);
856*28e138c6SAndroid Build Coastguard Worker for (i=st->frame_size;i<N;i++)
857*28e138c6SAndroid Build Coastguard Worker {
858*28e138c6SAndroid Build Coastguard Worker st->wtmp[i]=0;
859*28e138c6SAndroid Build Coastguard Worker }
860*28e138c6SAndroid Build Coastguard Worker spx_fft(st->fft_table, st->wtmp, &st->W[chan*N*K*M + j*N*K + speak*N]);
861*28e138c6SAndroid Build Coastguard Worker #endif
862*28e138c6SAndroid Build Coastguard Worker }
863*28e138c6SAndroid Build Coastguard Worker }
864*28e138c6SAndroid Build Coastguard Worker }
865*28e138c6SAndroid Build Coastguard Worker }
866*28e138c6SAndroid Build Coastguard Worker
867*28e138c6SAndroid Build Coastguard Worker /* So we can use power_spectrum_accum */
868*28e138c6SAndroid Build Coastguard Worker for (i=0;i<=st->frame_size;i++)
869*28e138c6SAndroid Build Coastguard Worker st->Rf[i] = st->Yf[i] = st->Xf[i] = 0;
870*28e138c6SAndroid Build Coastguard Worker
871*28e138c6SAndroid Build Coastguard Worker Dbf = 0;
872*28e138c6SAndroid Build Coastguard Worker See = 0;
873*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
874*28e138c6SAndroid Build Coastguard Worker /* Difference in response, this is used to estimate the variance of our residual power estimate */
875*28e138c6SAndroid Build Coastguard Worker for (chan = 0; chan < C; chan++)
876*28e138c6SAndroid Build Coastguard Worker {
877*28e138c6SAndroid Build Coastguard Worker spectral_mul_accum(st->X, st->W+chan*N*K*M, st->Y+chan*N, N, M*K);
878*28e138c6SAndroid Build Coastguard Worker spx_ifft(st->fft_table, st->Y+chan*N, st->y+chan*N);
879*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
880*28e138c6SAndroid Build Coastguard Worker st->e[chan*N+i] = SUB16(st->e[chan*N+i+st->frame_size], st->y[chan*N+i+st->frame_size]);
881*28e138c6SAndroid Build Coastguard Worker Dbf += 10+mdf_inner_prod(st->e+chan*N, st->e+chan*N, st->frame_size);
882*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
883*28e138c6SAndroid Build Coastguard Worker st->e[chan*N+i] = SUB16(st->input[chan*st->frame_size+i], st->y[chan*N+i+st->frame_size]);
884*28e138c6SAndroid Build Coastguard Worker See += mdf_inner_prod(st->e+chan*N, st->e+chan*N, st->frame_size);
885*28e138c6SAndroid Build Coastguard Worker }
886*28e138c6SAndroid Build Coastguard Worker #endif
887*28e138c6SAndroid Build Coastguard Worker
888*28e138c6SAndroid Build Coastguard Worker #ifndef TWO_PATH
889*28e138c6SAndroid Build Coastguard Worker Sff = See;
890*28e138c6SAndroid Build Coastguard Worker #endif
891*28e138c6SAndroid Build Coastguard Worker
892*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
893*28e138c6SAndroid Build Coastguard Worker /* Logic for updating the foreground filter */
894*28e138c6SAndroid Build Coastguard Worker
895*28e138c6SAndroid Build Coastguard Worker /* For two time windows, compute the mean of the energy difference, as well as the variance */
896*28e138c6SAndroid Build Coastguard Worker st->Davg1 = ADD32(MULT16_32_Q15(QCONST16(.6f,15),st->Davg1), MULT16_32_Q15(QCONST16(.4f,15),SUB32(Sff,See)));
897*28e138c6SAndroid Build Coastguard Worker st->Davg2 = ADD32(MULT16_32_Q15(QCONST16(.85f,15),st->Davg2), MULT16_32_Q15(QCONST16(.15f,15),SUB32(Sff,See)));
898*28e138c6SAndroid Build Coastguard Worker st->Dvar1 = FLOAT_ADD(FLOAT_MULT(VAR1_SMOOTH, st->Dvar1), FLOAT_MUL32U(MULT16_32_Q15(QCONST16(.4f,15),Sff), MULT16_32_Q15(QCONST16(.4f,15),Dbf)));
899*28e138c6SAndroid Build Coastguard Worker st->Dvar2 = FLOAT_ADD(FLOAT_MULT(VAR2_SMOOTH, st->Dvar2), FLOAT_MUL32U(MULT16_32_Q15(QCONST16(.15f,15),Sff), MULT16_32_Q15(QCONST16(.15f,15),Dbf)));
900*28e138c6SAndroid Build Coastguard Worker
901*28e138c6SAndroid Build Coastguard Worker /* Equivalent float code:
902*28e138c6SAndroid Build Coastguard Worker st->Davg1 = .6*st->Davg1 + .4*(Sff-See);
903*28e138c6SAndroid Build Coastguard Worker st->Davg2 = .85*st->Davg2 + .15*(Sff-See);
904*28e138c6SAndroid Build Coastguard Worker st->Dvar1 = .36*st->Dvar1 + .16*Sff*Dbf;
905*28e138c6SAndroid Build Coastguard Worker st->Dvar2 = .7225*st->Dvar2 + .0225*Sff*Dbf;
906*28e138c6SAndroid Build Coastguard Worker */
907*28e138c6SAndroid Build Coastguard Worker
908*28e138c6SAndroid Build Coastguard Worker update_foreground = 0;
909*28e138c6SAndroid Build Coastguard Worker /* Check if we have a statistically significant reduction in the residual echo */
910*28e138c6SAndroid Build Coastguard Worker /* Note that this is *not* Gaussian, so we need to be careful about the longer tail */
911*28e138c6SAndroid Build Coastguard Worker if (FLOAT_GT(FLOAT_MUL32U(SUB32(Sff,See),ABS32(SUB32(Sff,See))), FLOAT_MUL32U(Sff,Dbf)))
912*28e138c6SAndroid Build Coastguard Worker update_foreground = 1;
913*28e138c6SAndroid Build Coastguard Worker else if (FLOAT_GT(FLOAT_MUL32U(st->Davg1, ABS32(st->Davg1)), FLOAT_MULT(VAR1_UPDATE,(st->Dvar1))))
914*28e138c6SAndroid Build Coastguard Worker update_foreground = 1;
915*28e138c6SAndroid Build Coastguard Worker else if (FLOAT_GT(FLOAT_MUL32U(st->Davg2, ABS32(st->Davg2)), FLOAT_MULT(VAR2_UPDATE,(st->Dvar2))))
916*28e138c6SAndroid Build Coastguard Worker update_foreground = 1;
917*28e138c6SAndroid Build Coastguard Worker
918*28e138c6SAndroid Build Coastguard Worker /* Do we update? */
919*28e138c6SAndroid Build Coastguard Worker if (update_foreground)
920*28e138c6SAndroid Build Coastguard Worker {
921*28e138c6SAndroid Build Coastguard Worker st->Davg1 = st->Davg2 = 0;
922*28e138c6SAndroid Build Coastguard Worker st->Dvar1 = st->Dvar2 = FLOAT_ZERO;
923*28e138c6SAndroid Build Coastguard Worker /* Copy background filter to foreground filter */
924*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N*M*C*K;i++)
925*28e138c6SAndroid Build Coastguard Worker st->foreground[i] = EXTRACT16(PSHR32(st->W[i],16));
926*28e138c6SAndroid Build Coastguard Worker /* Apply a smooth transition so as to not introduce blocking artifacts */
927*28e138c6SAndroid Build Coastguard Worker for (chan = 0; chan < C; chan++)
928*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
929*28e138c6SAndroid Build Coastguard Worker st->e[chan*N+i+st->frame_size] = MULT16_16_Q15(st->window[i+st->frame_size],st->e[chan*N+i+st->frame_size]) + MULT16_16_Q15(st->window[i],st->y[chan*N+i+st->frame_size]);
930*28e138c6SAndroid Build Coastguard Worker } else {
931*28e138c6SAndroid Build Coastguard Worker int reset_background=0;
932*28e138c6SAndroid Build Coastguard Worker /* Otherwise, check if the background filter is significantly worse */
933*28e138c6SAndroid Build Coastguard Worker if (FLOAT_GT(FLOAT_MUL32U(NEG32(SUB32(Sff,See)),ABS32(SUB32(Sff,See))), FLOAT_MULT(VAR_BACKTRACK,FLOAT_MUL32U(Sff,Dbf))))
934*28e138c6SAndroid Build Coastguard Worker reset_background = 1;
935*28e138c6SAndroid Build Coastguard Worker if (FLOAT_GT(FLOAT_MUL32U(NEG32(st->Davg1), ABS32(st->Davg1)), FLOAT_MULT(VAR_BACKTRACK,st->Dvar1)))
936*28e138c6SAndroid Build Coastguard Worker reset_background = 1;
937*28e138c6SAndroid Build Coastguard Worker if (FLOAT_GT(FLOAT_MUL32U(NEG32(st->Davg2), ABS32(st->Davg2)), FLOAT_MULT(VAR_BACKTRACK,st->Dvar2)))
938*28e138c6SAndroid Build Coastguard Worker reset_background = 1;
939*28e138c6SAndroid Build Coastguard Worker if (reset_background)
940*28e138c6SAndroid Build Coastguard Worker {
941*28e138c6SAndroid Build Coastguard Worker /* Copy foreground filter to background filter */
942*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N*M*C*K;i++)
943*28e138c6SAndroid Build Coastguard Worker st->W[i] = SHL32(EXTEND32(st->foreground[i]),16);
944*28e138c6SAndroid Build Coastguard Worker /* We also need to copy the output so as to get correct adaptation */
945*28e138c6SAndroid Build Coastguard Worker for (chan = 0; chan < C; chan++)
946*28e138c6SAndroid Build Coastguard Worker {
947*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
948*28e138c6SAndroid Build Coastguard Worker st->y[chan*N+i+st->frame_size] = st->e[chan*N+i+st->frame_size];
949*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
950*28e138c6SAndroid Build Coastguard Worker st->e[chan*N+i] = SUB16(st->input[chan*st->frame_size+i], st->y[chan*N+i+st->frame_size]);
951*28e138c6SAndroid Build Coastguard Worker }
952*28e138c6SAndroid Build Coastguard Worker See = Sff;
953*28e138c6SAndroid Build Coastguard Worker st->Davg1 = st->Davg2 = 0;
954*28e138c6SAndroid Build Coastguard Worker st->Dvar1 = st->Dvar2 = FLOAT_ZERO;
955*28e138c6SAndroid Build Coastguard Worker }
956*28e138c6SAndroid Build Coastguard Worker }
957*28e138c6SAndroid Build Coastguard Worker #endif
958*28e138c6SAndroid Build Coastguard Worker
959*28e138c6SAndroid Build Coastguard Worker Sey = Syy = Sdd = 0;
960*28e138c6SAndroid Build Coastguard Worker for (chan = 0; chan < C; chan++)
961*28e138c6SAndroid Build Coastguard Worker {
962*28e138c6SAndroid Build Coastguard Worker /* Compute error signal (for the output with de-emphasis) */
963*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
964*28e138c6SAndroid Build Coastguard Worker {
965*28e138c6SAndroid Build Coastguard Worker spx_word32_t tmp_out;
966*28e138c6SAndroid Build Coastguard Worker #ifdef TWO_PATH
967*28e138c6SAndroid Build Coastguard Worker tmp_out = SUB32(EXTEND32(st->input[chan*st->frame_size+i]), EXTEND32(st->e[chan*N+i+st->frame_size]));
968*28e138c6SAndroid Build Coastguard Worker #else
969*28e138c6SAndroid Build Coastguard Worker tmp_out = SUB32(EXTEND32(st->input[chan*st->frame_size+i]), EXTEND32(st->y[chan*N+i+st->frame_size]));
970*28e138c6SAndroid Build Coastguard Worker #endif
971*28e138c6SAndroid Build Coastguard Worker tmp_out = ADD32(tmp_out, EXTEND32(MULT16_16_P15(st->preemph, st->memE[chan])));
972*28e138c6SAndroid Build Coastguard Worker /* This is an arbitrary test for saturation in the microphone signal */
973*28e138c6SAndroid Build Coastguard Worker if (in[i*C+chan] <= -32000 || in[i*C+chan] >= 32000)
974*28e138c6SAndroid Build Coastguard Worker {
975*28e138c6SAndroid Build Coastguard Worker if (st->saturated == 0)
976*28e138c6SAndroid Build Coastguard Worker st->saturated = 1;
977*28e138c6SAndroid Build Coastguard Worker }
978*28e138c6SAndroid Build Coastguard Worker out[i*C+chan] = WORD2INT(tmp_out);
979*28e138c6SAndroid Build Coastguard Worker st->memE[chan] = tmp_out;
980*28e138c6SAndroid Build Coastguard Worker }
981*28e138c6SAndroid Build Coastguard Worker
982*28e138c6SAndroid Build Coastguard Worker #ifdef DUMP_ECHO_CANCEL_DATA
983*28e138c6SAndroid Build Coastguard Worker dump_audio(in, far_end, out, st->frame_size);
984*28e138c6SAndroid Build Coastguard Worker #endif
985*28e138c6SAndroid Build Coastguard Worker
986*28e138c6SAndroid Build Coastguard Worker /* Compute error signal (filter update version) */
987*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
988*28e138c6SAndroid Build Coastguard Worker {
989*28e138c6SAndroid Build Coastguard Worker st->e[chan*N+i+st->frame_size] = st->e[chan*N+i];
990*28e138c6SAndroid Build Coastguard Worker st->e[chan*N+i] = 0;
991*28e138c6SAndroid Build Coastguard Worker }
992*28e138c6SAndroid Build Coastguard Worker
993*28e138c6SAndroid Build Coastguard Worker /* Compute a bunch of correlations */
994*28e138c6SAndroid Build Coastguard Worker /* FIXME: bad merge */
995*28e138c6SAndroid Build Coastguard Worker Sey += mdf_inner_prod(st->e+chan*N+st->frame_size, st->y+chan*N+st->frame_size, st->frame_size);
996*28e138c6SAndroid Build Coastguard Worker Syy += mdf_inner_prod(st->y+chan*N+st->frame_size, st->y+chan*N+st->frame_size, st->frame_size);
997*28e138c6SAndroid Build Coastguard Worker Sdd += mdf_inner_prod(st->input+chan*st->frame_size, st->input+chan*st->frame_size, st->frame_size);
998*28e138c6SAndroid Build Coastguard Worker
999*28e138c6SAndroid Build Coastguard Worker /* Convert error to frequency domain */
1000*28e138c6SAndroid Build Coastguard Worker spx_fft(st->fft_table, st->e+chan*N, st->E+chan*N);
1001*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
1002*28e138c6SAndroid Build Coastguard Worker st->y[i+chan*N] = 0;
1003*28e138c6SAndroid Build Coastguard Worker spx_fft(st->fft_table, st->y+chan*N, st->Y+chan*N);
1004*28e138c6SAndroid Build Coastguard Worker
1005*28e138c6SAndroid Build Coastguard Worker /* Compute power spectrum of echo (X), error (E) and filter response (Y) */
1006*28e138c6SAndroid Build Coastguard Worker power_spectrum_accum(st->E+chan*N, st->Rf, N);
1007*28e138c6SAndroid Build Coastguard Worker power_spectrum_accum(st->Y+chan*N, st->Yf, N);
1008*28e138c6SAndroid Build Coastguard Worker
1009*28e138c6SAndroid Build Coastguard Worker }
1010*28e138c6SAndroid Build Coastguard Worker
1011*28e138c6SAndroid Build Coastguard Worker /*printf ("%f %f %f %f\n", Sff, See, Syy, Sdd, st->update_cond);*/
1012*28e138c6SAndroid Build Coastguard Worker
1013*28e138c6SAndroid Build Coastguard Worker /* Do some sanity check */
1014*28e138c6SAndroid Build Coastguard Worker if (!(Syy>=0 && Sxx>=0 && See >= 0)
1015*28e138c6SAndroid Build Coastguard Worker #ifndef FIXED_POINT
1016*28e138c6SAndroid Build Coastguard Worker || !(Sff < N*1e9 && Syy < N*1e9 && Sxx < N*1e9)
1017*28e138c6SAndroid Build Coastguard Worker #endif
1018*28e138c6SAndroid Build Coastguard Worker )
1019*28e138c6SAndroid Build Coastguard Worker {
1020*28e138c6SAndroid Build Coastguard Worker /* Things have gone really bad */
1021*28e138c6SAndroid Build Coastguard Worker st->screwed_up += 50;
1022*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size*C;i++)
1023*28e138c6SAndroid Build Coastguard Worker out[i] = 0;
1024*28e138c6SAndroid Build Coastguard Worker } else if (SHR32(Sff, 2) > ADD32(Sdd, SHR32(MULT16_16(N, 10000),6)))
1025*28e138c6SAndroid Build Coastguard Worker {
1026*28e138c6SAndroid Build Coastguard Worker /* AEC seems to add lots of echo instead of removing it, let's see if it will improve */
1027*28e138c6SAndroid Build Coastguard Worker st->screwed_up++;
1028*28e138c6SAndroid Build Coastguard Worker } else {
1029*28e138c6SAndroid Build Coastguard Worker /* Everything's fine */
1030*28e138c6SAndroid Build Coastguard Worker st->screwed_up=0;
1031*28e138c6SAndroid Build Coastguard Worker }
1032*28e138c6SAndroid Build Coastguard Worker if (st->screwed_up>=50)
1033*28e138c6SAndroid Build Coastguard Worker {
1034*28e138c6SAndroid Build Coastguard Worker speex_warning("The echo canceller started acting funny and got slapped (reset). It swears it will behave now.");
1035*28e138c6SAndroid Build Coastguard Worker speex_echo_state_reset(st);
1036*28e138c6SAndroid Build Coastguard Worker return;
1037*28e138c6SAndroid Build Coastguard Worker }
1038*28e138c6SAndroid Build Coastguard Worker
1039*28e138c6SAndroid Build Coastguard Worker /* Add a small noise floor to make sure not to have problems when dividing */
1040*28e138c6SAndroid Build Coastguard Worker See = MAX32(See, SHR32(MULT16_16(N, 100),6));
1041*28e138c6SAndroid Build Coastguard Worker
1042*28e138c6SAndroid Build Coastguard Worker for (speak = 0; speak < K; speak++)
1043*28e138c6SAndroid Build Coastguard Worker {
1044*28e138c6SAndroid Build Coastguard Worker Sxx += mdf_inner_prod(st->x+speak*N+st->frame_size, st->x+speak*N+st->frame_size, st->frame_size);
1045*28e138c6SAndroid Build Coastguard Worker power_spectrum_accum(st->X+speak*N, st->Xf, N);
1046*28e138c6SAndroid Build Coastguard Worker }
1047*28e138c6SAndroid Build Coastguard Worker
1048*28e138c6SAndroid Build Coastguard Worker
1049*28e138c6SAndroid Build Coastguard Worker /* Smooth far end energy estimate over time */
1050*28e138c6SAndroid Build Coastguard Worker for (j=0;j<=st->frame_size;j++)
1051*28e138c6SAndroid Build Coastguard Worker st->power[j] = MULT16_32_Q15(ss_1,st->power[j]) + 1 + MULT16_32_Q15(ss,st->Xf[j]);
1052*28e138c6SAndroid Build Coastguard Worker
1053*28e138c6SAndroid Build Coastguard Worker /* Compute filtered spectra and (cross-)correlations */
1054*28e138c6SAndroid Build Coastguard Worker for (j=st->frame_size;j>=0;j--)
1055*28e138c6SAndroid Build Coastguard Worker {
1056*28e138c6SAndroid Build Coastguard Worker spx_float_t Eh, Yh;
1057*28e138c6SAndroid Build Coastguard Worker Eh = PSEUDOFLOAT(st->Rf[j] - st->Eh[j]);
1058*28e138c6SAndroid Build Coastguard Worker Yh = PSEUDOFLOAT(st->Yf[j] - st->Yh[j]);
1059*28e138c6SAndroid Build Coastguard Worker Pey = FLOAT_ADD(Pey,FLOAT_MULT(Eh,Yh));
1060*28e138c6SAndroid Build Coastguard Worker Pyy = FLOAT_ADD(Pyy,FLOAT_MULT(Yh,Yh));
1061*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
1062*28e138c6SAndroid Build Coastguard Worker st->Eh[j] = MAC16_32_Q15(MULT16_32_Q15(SUB16(32767,st->spec_average),st->Eh[j]), st->spec_average, st->Rf[j]);
1063*28e138c6SAndroid Build Coastguard Worker st->Yh[j] = MAC16_32_Q15(MULT16_32_Q15(SUB16(32767,st->spec_average),st->Yh[j]), st->spec_average, st->Yf[j]);
1064*28e138c6SAndroid Build Coastguard Worker #else
1065*28e138c6SAndroid Build Coastguard Worker st->Eh[j] = (1-st->spec_average)*st->Eh[j] + st->spec_average*st->Rf[j];
1066*28e138c6SAndroid Build Coastguard Worker st->Yh[j] = (1-st->spec_average)*st->Yh[j] + st->spec_average*st->Yf[j];
1067*28e138c6SAndroid Build Coastguard Worker #endif
1068*28e138c6SAndroid Build Coastguard Worker }
1069*28e138c6SAndroid Build Coastguard Worker
1070*28e138c6SAndroid Build Coastguard Worker Pyy = FLOAT_SQRT(Pyy);
1071*28e138c6SAndroid Build Coastguard Worker Pey = FLOAT_DIVU(Pey,Pyy);
1072*28e138c6SAndroid Build Coastguard Worker
1073*28e138c6SAndroid Build Coastguard Worker /* Compute correlation updatete rate */
1074*28e138c6SAndroid Build Coastguard Worker tmp32 = MULT16_32_Q15(st->beta0,Syy);
1075*28e138c6SAndroid Build Coastguard Worker if (tmp32 > MULT16_32_Q15(st->beta_max,See))
1076*28e138c6SAndroid Build Coastguard Worker tmp32 = MULT16_32_Q15(st->beta_max,See);
1077*28e138c6SAndroid Build Coastguard Worker alpha = FLOAT_DIV32(tmp32, See);
1078*28e138c6SAndroid Build Coastguard Worker alpha_1 = FLOAT_SUB(FLOAT_ONE, alpha);
1079*28e138c6SAndroid Build Coastguard Worker /* Update correlations (recursive average) */
1080*28e138c6SAndroid Build Coastguard Worker st->Pey = FLOAT_ADD(FLOAT_MULT(alpha_1,st->Pey) , FLOAT_MULT(alpha,Pey));
1081*28e138c6SAndroid Build Coastguard Worker st->Pyy = FLOAT_ADD(FLOAT_MULT(alpha_1,st->Pyy) , FLOAT_MULT(alpha,Pyy));
1082*28e138c6SAndroid Build Coastguard Worker if (FLOAT_LT(st->Pyy, FLOAT_ONE))
1083*28e138c6SAndroid Build Coastguard Worker st->Pyy = FLOAT_ONE;
1084*28e138c6SAndroid Build Coastguard Worker /* We don't really hope to get better than 33 dB (MIN_LEAK-3dB) attenuation anyway */
1085*28e138c6SAndroid Build Coastguard Worker if (FLOAT_LT(st->Pey, FLOAT_MULT(MIN_LEAK,st->Pyy)))
1086*28e138c6SAndroid Build Coastguard Worker st->Pey = FLOAT_MULT(MIN_LEAK,st->Pyy);
1087*28e138c6SAndroid Build Coastguard Worker if (FLOAT_GT(st->Pey, st->Pyy))
1088*28e138c6SAndroid Build Coastguard Worker st->Pey = st->Pyy;
1089*28e138c6SAndroid Build Coastguard Worker /* leak_estimate is the linear regression result */
1090*28e138c6SAndroid Build Coastguard Worker st->leak_estimate = FLOAT_EXTRACT16(FLOAT_SHL(FLOAT_DIVU(st->Pey, st->Pyy),14));
1091*28e138c6SAndroid Build Coastguard Worker /* This looks like a stupid bug, but it's right (because we convert from Q14 to Q15) */
1092*28e138c6SAndroid Build Coastguard Worker if (st->leak_estimate > 16383)
1093*28e138c6SAndroid Build Coastguard Worker st->leak_estimate = 32767;
1094*28e138c6SAndroid Build Coastguard Worker else
1095*28e138c6SAndroid Build Coastguard Worker st->leak_estimate = SHL16(st->leak_estimate,1);
1096*28e138c6SAndroid Build Coastguard Worker /*printf ("%f\n", st->leak_estimate);*/
1097*28e138c6SAndroid Build Coastguard Worker
1098*28e138c6SAndroid Build Coastguard Worker /* Compute Residual to Error Ratio */
1099*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
1100*28e138c6SAndroid Build Coastguard Worker tmp32 = MULT16_32_Q15(st->leak_estimate,Syy);
1101*28e138c6SAndroid Build Coastguard Worker tmp32 = ADD32(SHR32(Sxx,13), ADD32(tmp32, SHL32(tmp32,1)));
1102*28e138c6SAndroid Build Coastguard Worker /* Check for y in e (lower bound on RER) */
1103*28e138c6SAndroid Build Coastguard Worker {
1104*28e138c6SAndroid Build Coastguard Worker spx_float_t bound = PSEUDOFLOAT(Sey);
1105*28e138c6SAndroid Build Coastguard Worker bound = FLOAT_DIVU(FLOAT_MULT(bound, bound), PSEUDOFLOAT(ADD32(1,Syy)));
1106*28e138c6SAndroid Build Coastguard Worker if (FLOAT_GT(bound, PSEUDOFLOAT(See)))
1107*28e138c6SAndroid Build Coastguard Worker tmp32 = See;
1108*28e138c6SAndroid Build Coastguard Worker else if (tmp32 < FLOAT_EXTRACT32(bound))
1109*28e138c6SAndroid Build Coastguard Worker tmp32 = FLOAT_EXTRACT32(bound);
1110*28e138c6SAndroid Build Coastguard Worker }
1111*28e138c6SAndroid Build Coastguard Worker if (tmp32 > SHR32(See,1))
1112*28e138c6SAndroid Build Coastguard Worker tmp32 = SHR32(See,1);
1113*28e138c6SAndroid Build Coastguard Worker RER = FLOAT_EXTRACT16(FLOAT_SHL(FLOAT_DIV32(tmp32,See),15));
1114*28e138c6SAndroid Build Coastguard Worker #else
1115*28e138c6SAndroid Build Coastguard Worker RER = (.0001*Sxx + 3.*MULT16_32_Q15(st->leak_estimate,Syy)) / See;
1116*28e138c6SAndroid Build Coastguard Worker /* Check for y in e (lower bound on RER) */
1117*28e138c6SAndroid Build Coastguard Worker if (RER < Sey*Sey/(1+See*Syy))
1118*28e138c6SAndroid Build Coastguard Worker RER = Sey*Sey/(1+See*Syy);
1119*28e138c6SAndroid Build Coastguard Worker if (RER > .5)
1120*28e138c6SAndroid Build Coastguard Worker RER = .5;
1121*28e138c6SAndroid Build Coastguard Worker #endif
1122*28e138c6SAndroid Build Coastguard Worker
1123*28e138c6SAndroid Build Coastguard Worker /* We consider that the filter has had minimal adaptation if the following is true*/
1124*28e138c6SAndroid Build Coastguard Worker if (!st->adapted && st->sum_adapt > SHL32(EXTEND32(M),15) && MULT16_32_Q15(st->leak_estimate,Syy) > MULT16_32_Q15(QCONST16(.03f,15),Syy))
1125*28e138c6SAndroid Build Coastguard Worker {
1126*28e138c6SAndroid Build Coastguard Worker st->adapted = 1;
1127*28e138c6SAndroid Build Coastguard Worker }
1128*28e138c6SAndroid Build Coastguard Worker
1129*28e138c6SAndroid Build Coastguard Worker if (st->adapted)
1130*28e138c6SAndroid Build Coastguard Worker {
1131*28e138c6SAndroid Build Coastguard Worker /* Normal learning rate calculation once we're past the minimal adaptation phase */
1132*28e138c6SAndroid Build Coastguard Worker for (i=0;i<=st->frame_size;i++)
1133*28e138c6SAndroid Build Coastguard Worker {
1134*28e138c6SAndroid Build Coastguard Worker spx_word32_t r, e;
1135*28e138c6SAndroid Build Coastguard Worker /* Compute frequency-domain adaptation mask */
1136*28e138c6SAndroid Build Coastguard Worker r = MULT16_32_Q15(st->leak_estimate,SHL32(st->Yf[i],3));
1137*28e138c6SAndroid Build Coastguard Worker e = SHL32(st->Rf[i],3)+1;
1138*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
1139*28e138c6SAndroid Build Coastguard Worker if (r>SHR32(e,1))
1140*28e138c6SAndroid Build Coastguard Worker r = SHR32(e,1);
1141*28e138c6SAndroid Build Coastguard Worker #else
1142*28e138c6SAndroid Build Coastguard Worker if (r>.5*e)
1143*28e138c6SAndroid Build Coastguard Worker r = .5*e;
1144*28e138c6SAndroid Build Coastguard Worker #endif
1145*28e138c6SAndroid Build Coastguard Worker r = MULT16_32_Q15(QCONST16(.7,15),r) + MULT16_32_Q15(QCONST16(.3,15),(spx_word32_t)(MULT16_32_Q15(RER,e)));
1146*28e138c6SAndroid Build Coastguard Worker /*st->power_1[i] = adapt_rate*r/(e*(1+st->power[i]));*/
1147*28e138c6SAndroid Build Coastguard Worker st->power_1[i] = FLOAT_SHL(FLOAT_DIV32_FLOAT(r,FLOAT_MUL32U(e,st->power[i]+10)),WEIGHT_SHIFT+16);
1148*28e138c6SAndroid Build Coastguard Worker }
1149*28e138c6SAndroid Build Coastguard Worker } else {
1150*28e138c6SAndroid Build Coastguard Worker /* Temporary adaption rate if filter is not yet adapted enough */
1151*28e138c6SAndroid Build Coastguard Worker spx_word16_t adapt_rate=0;
1152*28e138c6SAndroid Build Coastguard Worker
1153*28e138c6SAndroid Build Coastguard Worker if (Sxx > SHR32(MULT16_16(N, 1000),6))
1154*28e138c6SAndroid Build Coastguard Worker {
1155*28e138c6SAndroid Build Coastguard Worker tmp32 = MULT16_32_Q15(QCONST16(.25f, 15), Sxx);
1156*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
1157*28e138c6SAndroid Build Coastguard Worker if (tmp32 > SHR32(See,2))
1158*28e138c6SAndroid Build Coastguard Worker tmp32 = SHR32(See,2);
1159*28e138c6SAndroid Build Coastguard Worker #else
1160*28e138c6SAndroid Build Coastguard Worker if (tmp32 > .25*See)
1161*28e138c6SAndroid Build Coastguard Worker tmp32 = .25*See;
1162*28e138c6SAndroid Build Coastguard Worker #endif
1163*28e138c6SAndroid Build Coastguard Worker adapt_rate = FLOAT_EXTRACT16(FLOAT_SHL(FLOAT_DIV32(tmp32, See),15));
1164*28e138c6SAndroid Build Coastguard Worker }
1165*28e138c6SAndroid Build Coastguard Worker for (i=0;i<=st->frame_size;i++)
1166*28e138c6SAndroid Build Coastguard Worker st->power_1[i] = FLOAT_SHL(FLOAT_DIV32(EXTEND32(adapt_rate),ADD32(st->power[i],10)),WEIGHT_SHIFT+1);
1167*28e138c6SAndroid Build Coastguard Worker
1168*28e138c6SAndroid Build Coastguard Worker
1169*28e138c6SAndroid Build Coastguard Worker /* How much have we adapted so far? */
1170*28e138c6SAndroid Build Coastguard Worker st->sum_adapt = ADD32(st->sum_adapt,adapt_rate);
1171*28e138c6SAndroid Build Coastguard Worker }
1172*28e138c6SAndroid Build Coastguard Worker
1173*28e138c6SAndroid Build Coastguard Worker /* FIXME: MC conversion required */
1174*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
1175*28e138c6SAndroid Build Coastguard Worker st->last_y[i] = st->last_y[st->frame_size+i];
1176*28e138c6SAndroid Build Coastguard Worker if (st->adapted)
1177*28e138c6SAndroid Build Coastguard Worker {
1178*28e138c6SAndroid Build Coastguard Worker /* If the filter is adapted, take the filtered echo */
1179*28e138c6SAndroid Build Coastguard Worker for (i=0;i<st->frame_size;i++)
1180*28e138c6SAndroid Build Coastguard Worker st->last_y[st->frame_size+i] = in[i]-out[i];
1181*28e138c6SAndroid Build Coastguard Worker } else {
1182*28e138c6SAndroid Build Coastguard Worker /* If filter isn't adapted yet, all we can do is take the far end signal directly */
1183*28e138c6SAndroid Build Coastguard Worker /* moved earlier: for (i=0;i<N;i++)
1184*28e138c6SAndroid Build Coastguard Worker st->last_y[i] = st->x[i];*/
1185*28e138c6SAndroid Build Coastguard Worker }
1186*28e138c6SAndroid Build Coastguard Worker
1187*28e138c6SAndroid Build Coastguard Worker }
1188*28e138c6SAndroid Build Coastguard Worker
1189*28e138c6SAndroid Build Coastguard Worker /* Compute spectrum of estimated echo for use in an echo post-filter */
speex_echo_get_residual(SpeexEchoState * st,spx_word32_t * residual_echo,int len)1190*28e138c6SAndroid Build Coastguard Worker void speex_echo_get_residual(SpeexEchoState *st, spx_word32_t *residual_echo, int len)
1191*28e138c6SAndroid Build Coastguard Worker {
1192*28e138c6SAndroid Build Coastguard Worker int i;
1193*28e138c6SAndroid Build Coastguard Worker spx_word16_t leak2;
1194*28e138c6SAndroid Build Coastguard Worker int N;
1195*28e138c6SAndroid Build Coastguard Worker
1196*28e138c6SAndroid Build Coastguard Worker N = st->window_size;
1197*28e138c6SAndroid Build Coastguard Worker
1198*28e138c6SAndroid Build Coastguard Worker /* Apply hanning window (should pre-compute it)*/
1199*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N;i++)
1200*28e138c6SAndroid Build Coastguard Worker st->y[i] = MULT16_16_Q15(st->window[i],st->last_y[i]);
1201*28e138c6SAndroid Build Coastguard Worker
1202*28e138c6SAndroid Build Coastguard Worker /* Compute power spectrum of the echo */
1203*28e138c6SAndroid Build Coastguard Worker spx_fft(st->fft_table, st->y, st->Y);
1204*28e138c6SAndroid Build Coastguard Worker power_spectrum(st->Y, residual_echo, N);
1205*28e138c6SAndroid Build Coastguard Worker
1206*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
1207*28e138c6SAndroid Build Coastguard Worker if (st->leak_estimate > 16383)
1208*28e138c6SAndroid Build Coastguard Worker leak2 = 32767;
1209*28e138c6SAndroid Build Coastguard Worker else
1210*28e138c6SAndroid Build Coastguard Worker leak2 = SHL16(st->leak_estimate, 1);
1211*28e138c6SAndroid Build Coastguard Worker #else
1212*28e138c6SAndroid Build Coastguard Worker if (st->leak_estimate>.5)
1213*28e138c6SAndroid Build Coastguard Worker leak2 = 1;
1214*28e138c6SAndroid Build Coastguard Worker else
1215*28e138c6SAndroid Build Coastguard Worker leak2 = 2*st->leak_estimate;
1216*28e138c6SAndroid Build Coastguard Worker #endif
1217*28e138c6SAndroid Build Coastguard Worker /* Estimate residual echo */
1218*28e138c6SAndroid Build Coastguard Worker for (i=0;i<=st->frame_size;i++)
1219*28e138c6SAndroid Build Coastguard Worker residual_echo[i] = (spx_int32_t)MULT16_32_Q15(leak2,residual_echo[i]);
1220*28e138c6SAndroid Build Coastguard Worker
1221*28e138c6SAndroid Build Coastguard Worker }
1222*28e138c6SAndroid Build Coastguard Worker
speex_echo_ctl(SpeexEchoState * st,int request,void * ptr)1223*28e138c6SAndroid Build Coastguard Worker EXPORT int speex_echo_ctl(SpeexEchoState *st, int request, void *ptr)
1224*28e138c6SAndroid Build Coastguard Worker {
1225*28e138c6SAndroid Build Coastguard Worker switch(request)
1226*28e138c6SAndroid Build Coastguard Worker {
1227*28e138c6SAndroid Build Coastguard Worker
1228*28e138c6SAndroid Build Coastguard Worker case SPEEX_ECHO_GET_FRAME_SIZE:
1229*28e138c6SAndroid Build Coastguard Worker (*(int*)ptr) = st->frame_size;
1230*28e138c6SAndroid Build Coastguard Worker break;
1231*28e138c6SAndroid Build Coastguard Worker case SPEEX_ECHO_SET_SAMPLING_RATE:
1232*28e138c6SAndroid Build Coastguard Worker st->sampling_rate = (*(int*)ptr);
1233*28e138c6SAndroid Build Coastguard Worker st->spec_average = DIV32_16(SHL32(EXTEND32(st->frame_size), 15), st->sampling_rate);
1234*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
1235*28e138c6SAndroid Build Coastguard Worker st->beta0 = DIV32_16(SHL32(EXTEND32(st->frame_size), 16), st->sampling_rate);
1236*28e138c6SAndroid Build Coastguard Worker st->beta_max = DIV32_16(SHL32(EXTEND32(st->frame_size), 14), st->sampling_rate);
1237*28e138c6SAndroid Build Coastguard Worker #else
1238*28e138c6SAndroid Build Coastguard Worker st->beta0 = (2.0f*st->frame_size)/st->sampling_rate;
1239*28e138c6SAndroid Build Coastguard Worker st->beta_max = (.5f*st->frame_size)/st->sampling_rate;
1240*28e138c6SAndroid Build Coastguard Worker #endif
1241*28e138c6SAndroid Build Coastguard Worker if (st->sampling_rate<12000)
1242*28e138c6SAndroid Build Coastguard Worker st->notch_radius = QCONST16(.9, 15);
1243*28e138c6SAndroid Build Coastguard Worker else if (st->sampling_rate<24000)
1244*28e138c6SAndroid Build Coastguard Worker st->notch_radius = QCONST16(.982, 15);
1245*28e138c6SAndroid Build Coastguard Worker else
1246*28e138c6SAndroid Build Coastguard Worker st->notch_radius = QCONST16(.992, 15);
1247*28e138c6SAndroid Build Coastguard Worker break;
1248*28e138c6SAndroid Build Coastguard Worker case SPEEX_ECHO_GET_SAMPLING_RATE:
1249*28e138c6SAndroid Build Coastguard Worker (*(int*)ptr) = st->sampling_rate;
1250*28e138c6SAndroid Build Coastguard Worker break;
1251*28e138c6SAndroid Build Coastguard Worker case SPEEX_ECHO_GET_IMPULSE_RESPONSE_SIZE:
1252*28e138c6SAndroid Build Coastguard Worker /*FIXME: Implement this for multiple channels */
1253*28e138c6SAndroid Build Coastguard Worker *((spx_int32_t *)ptr) = st->M * st->frame_size;
1254*28e138c6SAndroid Build Coastguard Worker break;
1255*28e138c6SAndroid Build Coastguard Worker case SPEEX_ECHO_GET_IMPULSE_RESPONSE:
1256*28e138c6SAndroid Build Coastguard Worker {
1257*28e138c6SAndroid Build Coastguard Worker int M = st->M, N = st->window_size, n = st->frame_size, i, j;
1258*28e138c6SAndroid Build Coastguard Worker spx_int32_t *filt = (spx_int32_t *) ptr;
1259*28e138c6SAndroid Build Coastguard Worker for(j=0;j<M;j++)
1260*28e138c6SAndroid Build Coastguard Worker {
1261*28e138c6SAndroid Build Coastguard Worker /*FIXME: Implement this for multiple channels */
1262*28e138c6SAndroid Build Coastguard Worker #ifdef FIXED_POINT
1263*28e138c6SAndroid Build Coastguard Worker for (i=0;i<N;i++)
1264*28e138c6SAndroid Build Coastguard Worker st->wtmp2[i] = EXTRACT16(PSHR32(st->W[j*N+i],16+NORMALIZE_SCALEDOWN));
1265*28e138c6SAndroid Build Coastguard Worker spx_ifft(st->fft_table, st->wtmp2, st->wtmp);
1266*28e138c6SAndroid Build Coastguard Worker #else
1267*28e138c6SAndroid Build Coastguard Worker spx_ifft(st->fft_table, &st->W[j*N], st->wtmp);
1268*28e138c6SAndroid Build Coastguard Worker #endif
1269*28e138c6SAndroid Build Coastguard Worker for(i=0;i<n;i++)
1270*28e138c6SAndroid Build Coastguard Worker filt[j*n+i] = PSHR32(MULT16_16(32767,st->wtmp[i]), WEIGHT_SHIFT-NORMALIZE_SCALEDOWN);
1271*28e138c6SAndroid Build Coastguard Worker }
1272*28e138c6SAndroid Build Coastguard Worker }
1273*28e138c6SAndroid Build Coastguard Worker break;
1274*28e138c6SAndroid Build Coastguard Worker default:
1275*28e138c6SAndroid Build Coastguard Worker speex_warning_int("Unknown speex_echo_ctl request: ", request);
1276*28e138c6SAndroid Build Coastguard Worker return -1;
1277*28e138c6SAndroid Build Coastguard Worker }
1278*28e138c6SAndroid Build Coastguard Worker return 0;
1279*28e138c6SAndroid Build Coastguard Worker }
1280