Debian Codegraph @

libtwolame/subband.c

raw
1 /*
2 * TwoLAME: an optimized MPEG Audio Layer Two encoder
3 *
4 * Copyright (C) 2001-2004 Michael Cheng
5 * Copyright (C) 2004-2018 The TwoLAME Project
6 *
7 * This library is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2.1 of the License, or (at your option) any later version.
11 *
12 * This library is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
16 *
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with this library; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 *
21 */
22
23
24 #include <stdio.h>
25 #include <string.h>
26 #include <math.h>
27
28 #include "twolame.h"
29 #include "common.h"
30 #include "mem.h"
31 #include "bitbuffer.h"
32 #include "enwindow.h"
33 #include "subband.h"
34
35
36 static void create_dct_matrix(FLOAT filter[16][32])
37 {
38 register int i, k;
39
40 for (i = 0; i < 16; i++)
41 for (k = 0; k < 32; k++) {
42 if ((filter[i][k] = 1e9 * cos((FLOAT) ((2 * i + 1) * k * PI64))) >= 0)
43 modf(filter[i][k] + 0.5, &filter[i][k]);
44 else
45 modf(filter[i][k] - 0.5, &filter[i][k]);
46 filter[i][k] *= 1e-9;
47 }
48 }
49
50 int twolame_init_subband(subband_mem * smem)
51 {
52 memset(smem, 0, sizeof(subband_mem));
53 create_dct_matrix(smem->m);
54
55 return 0;
56 }
57
58
59 void twolame_window_filter_subband(subband_mem * smem, short *pBuffer, int ch, FLOAT s[SBLIMIT])
60 {
61 register int i, j;
62 int pa, pb, pc, pd, pe, pf, pg, ph;
63 FLOAT t;
64 FLOAT *dp, *dp2;
65 const FLOAT *pEnw;
66 FLOAT y[64];
67 FLOAT yprime[32];
68
69 dp = smem->x[ch] + smem->off[ch] + smem->half[ch] * 256;
70
71 /* replace 32 oldest samples with 32 new samples */
72 for (i = 0; i < 32; i++)
73 dp[(31 - i) * 8] = (FLOAT) pBuffer[i] / SCALE;
74
75 // looks like "school example" but does faster ...
76 dp = (smem->x[ch] + smem->half[ch] * 256);
77 pa = smem->off[ch];
78 pb = (pa + 1) % 8;
79 pc = (pa + 2) % 8;
80 pd = (pa + 3) % 8;
81 pe = (pa + 4) % 8;
82 pf = (pa + 5) % 8;
83 pg = (pa + 6) % 8;
84 ph = (pa + 7) % 8;
85
86 for (i = 0; i < 32; i++) {
87 dp2 = dp + i * 8;
88 pEnw = enwindow + i;
89 t = dp2[pa] * pEnw[0];
90 t += dp2[pb] * pEnw[64];
91 t += dp2[pc] * pEnw[128];
92 t += dp2[pd] * pEnw[192];
93 t += dp2[pe] * pEnw[256];
94 t += dp2[pf] * pEnw[320];
95 t += dp2[pg] * pEnw[384];
96 t += dp2[ph] * pEnw[448];
97 y[i] = t;
98 }
99
100 yprime[0] = y[16]; // Michael Chen's dct filter
101
102 dp = smem->half[ch] ? smem->x[ch] : (smem->x[ch] + 256);
103 pa = smem->half[ch] ? (smem->off[ch] + 1) & 7 : smem->off[ch];
104 pb = (pa + 1) % 8;
105 pc = (pa + 2) % 8;
106 pd = (pa + 3) % 8;
107 pe = (pa + 4) % 8;
108 pf = (pa + 5) % 8;
109 pg = (pa + 6) % 8;
110 ph = (pa + 7) % 8;
111
112 for (i = 0; i < 32; i++) {
113 dp2 = dp + i * 8;
114 pEnw = enwindow + i + 32;
115 t = dp2[pa] * pEnw[0];
116 t += dp2[pb] * pEnw[64];
117 t += dp2[pc] * pEnw[128];
118 t += dp2[pd] * pEnw[192];
119 t += dp2[pe] * pEnw[256];
120 t += dp2[pf] * pEnw[320];
121 t += dp2[pg] * pEnw[384];
122 t += dp2[ph] * pEnw[448];
123 y[i + 32] = t;
124 // 1st pass on Michael Chen's dct filter
125 if (i > 0 && i < 17)
126 yprime[i] = y[i + 16] + y[16 - i];
127 }
128
129 // 2nd pass on Michael Chen's dct filter
130 for (i = 17; i < 32; i++)
131 yprime[i] = y[i + 16] - y[80 - i];
132
133 for (i = 15; i >= 0; i--) {
134 register FLOAT s0 = 0.0, s1 = 0.0;
135 register FLOAT *mp = smem->m[i];
136 register FLOAT *xinp = yprime;
137 for (j = 0; j < 8; j++) {
138 s0 += *mp++ * *xinp++;
139 s1 += *mp++ * *xinp++;
140 s0 += *mp++ * *xinp++;
141 s1 += *mp++ * *xinp++;
142 }
143 s[i] = s0 + s1;
144 s[31 - i] = s0 - s1;
145 }
146
147 smem->half[ch] = (smem->half[ch] + 1) & 1;
148
149 if (smem->half[ch] == 1)
150 smem->off[ch] = (smem->off[ch] + 7) & 7;
151 }
152
153
154 // vim:ts=4:sw=4:nowrap: