17e819f9771bc29df0f6257c5ce28ceae3130d2e
[ffmpeg.git] / libavcodec / opusdsp.c
1 /*
2  * This file is part of FFmpeg.
3  *
4  * FFmpeg is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU Lesser General Public
6  * License as published by the Free Software Foundation; either
7  * version 2.1 of the License, or (at your option) any later version.
8  *
9  * FFmpeg is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * Lesser General Public License for more details.
13  *
14  * You should have received a copy of the GNU Lesser General Public
15  * License along with FFmpeg; if not, write to the Free Software
16  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
17  */
18
19 #include "opusdsp.h"
20
21 static void postfilter_c(float *data, int period, float *gains, int len)
22 {
23     const float g0 = gains[0];
24     const float g1 = gains[1];
25     const float g2 = gains[2];
26
27     float x4 = data[-period - 2];
28     float x3 = data[-period - 1];
29     float x2 = data[-period + 0];
30     float x1 = data[-period + 1];
31
32     for (int i = 0; i < len; i++) {
33         float x0 = data[i - period + 2];
34         data[i] += g0 * x2        +
35                    g1 * (x1 + x3) +
36                    g2 * (x0 + x4);
37         x4 = x3;
38         x3 = x2;
39         x2 = x1;
40         x1 = x0;
41     }
42 }
43
44 static float deemphasis_c(float *y, float *x, float coeff, int len)
45 {
46     float state = coeff;
47
48     for (int i = 0; i < len; i++) {
49         const float tmp = x[i] + state;
50         state = tmp * CELT_EMPH_COEFF;
51         y[i] = tmp;
52     }
53
54     return state;
55 }
56
57 av_cold void ff_opus_dsp_init(OpusDSP *ctx)
58 {
59     ctx->postfilter = postfilter_c;
60     ctx->deemphasis = deemphasis_c;
61
62     if (ARCH_X86)
63         ff_opus_dsp_init_x86(ctx);
64 }