| 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: |