Suga koubou / Mbed 2 deprecated madplayer_lpc4088

MP3 Player. You can change fwd/rev speed and skip. see: http://mbed.org/users/okini3939/notebook/lpc4088_madplayer/

Dependencies:   I2SSlave SDFileSystem TLV320 mbed

madplayer/synth.cpp@0:8ba6230eefbd, 2014-02-18 (annotated)

Committer:
okini3939
Date:
Tue Feb 18 00:22:50 2014 +0000
Revision:
0:8ba6230eefbd
1st build

Who changed what in which revision?

UserRevisionLine numberNew contents of line
okini3939 0:8ba6230eefbd 1 /*
okini3939 0:8ba6230eefbd 2 * libmad - MPEG audio decoder library
okini3939 0:8ba6230eefbd 3 * Copyright (C) 2000-2004 Underbit Technologies, Inc.
okini3939 0:8ba6230eefbd 4 *
okini3939 0:8ba6230eefbd 5 * This program is free software; you can redistribute it and/or modify
okini3939 0:8ba6230eefbd 6 * it under the terms of the GNU General Public License as published by
okini3939 0:8ba6230eefbd 7 * the Free Software Foundation; either version 2 of the License, or
okini3939 0:8ba6230eefbd 8 * (at your option) any later version.
okini3939 0:8ba6230eefbd 9 *
okini3939 0:8ba6230eefbd 10 * This program is distributed in the hope that it will be useful,
okini3939 0:8ba6230eefbd 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
okini3939 0:8ba6230eefbd 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
okini3939 0:8ba6230eefbd 13 * GNU General Public License for more details.
okini3939 0:8ba6230eefbd 14 *
okini3939 0:8ba6230eefbd 15 * You should have received a copy of the GNU General Public License
okini3939 0:8ba6230eefbd 16 * along with this program; if not, write to the Free Software
okini3939 0:8ba6230eefbd 17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
okini3939 0:8ba6230eefbd 18 *
okini3939 0:8ba6230eefbd 19 * $Id: synth.c,v 1.1 2010/11/23 20:12:57 andy Exp $
okini3939 0:8ba6230eefbd 20 */
okini3939 0:8ba6230eefbd 21
okini3939 0:8ba6230eefbd 22 # include "config.h"
okini3939 0:8ba6230eefbd 23
okini3939 0:8ba6230eefbd 24 # include "global.h"
okini3939 0:8ba6230eefbd 25
okini3939 0:8ba6230eefbd 26 # include "fixed.h"
okini3939 0:8ba6230eefbd 27 # include "frame.h"
okini3939 0:8ba6230eefbd 28 # include "synth.h"
okini3939 0:8ba6230eefbd 29
okini3939 0:8ba6230eefbd 30 /*
okini3939 0:8ba6230eefbd 31 * NAME: synth->init()
okini3939 0:8ba6230eefbd 32 * DESCRIPTION: initialize synth struct
okini3939 0:8ba6230eefbd 33 */
okini3939 0:8ba6230eefbd 34 void mad_synth_init(struct mad_synth *synth)
okini3939 0:8ba6230eefbd 35 {
okini3939 0:8ba6230eefbd 36 mad_synth_mute(synth);
okini3939 0:8ba6230eefbd 37
okini3939 0:8ba6230eefbd 38 synth->phase = 0;
okini3939 0:8ba6230eefbd 39
okini3939 0:8ba6230eefbd 40 synth->pcm.samplerate = 0;
okini3939 0:8ba6230eefbd 41 synth->pcm.channels = 0;
okini3939 0:8ba6230eefbd 42 synth->pcm.length = 0;
okini3939 0:8ba6230eefbd 43 }
okini3939 0:8ba6230eefbd 44
okini3939 0:8ba6230eefbd 45 /*
okini3939 0:8ba6230eefbd 46 * NAME: synth->mute()
okini3939 0:8ba6230eefbd 47 * DESCRIPTION: zero all polyphase filterbank values, resetting synthesis
okini3939 0:8ba6230eefbd 48 */
okini3939 0:8ba6230eefbd 49 void mad_synth_mute(struct mad_synth *synth)
okini3939 0:8ba6230eefbd 50 {
okini3939 0:8ba6230eefbd 51 unsigned int ch, s, v;
okini3939 0:8ba6230eefbd 52
okini3939 0:8ba6230eefbd 53 for (ch = 0; ch < 2; ++ch) {
okini3939 0:8ba6230eefbd 54 for (s = 0; s < 16; ++s) {
okini3939 0:8ba6230eefbd 55 for (v = 0; v < 8; ++v) {
okini3939 0:8ba6230eefbd 56 synth->filter[ch][0][0][s][v] = synth->filter[ch][0][1][s][v] =
okini3939 0:8ba6230eefbd 57 synth->filter[ch][1][0][s][v] = synth->filter[ch][1][1][s][v] = 0;
okini3939 0:8ba6230eefbd 58 }
okini3939 0:8ba6230eefbd 59 }
okini3939 0:8ba6230eefbd 60 }
okini3939 0:8ba6230eefbd 61 }
okini3939 0:8ba6230eefbd 62
okini3939 0:8ba6230eefbd 63 /*
okini3939 0:8ba6230eefbd 64 * An optional optimization called here the Subband Synthesis Optimization
okini3939 0:8ba6230eefbd 65 * (SSO) improves the performance of subband synthesis at the expense of
okini3939 0:8ba6230eefbd 66 * accuracy.
okini3939 0:8ba6230eefbd 67 *
okini3939 0:8ba6230eefbd 68 * The idea is to simplify 32x32->64-bit multiplication to 32x32->32 such
okini3939 0:8ba6230eefbd 69 * that extra scaling and rounding are not necessary. This often allows the
okini3939 0:8ba6230eefbd 70 * compiler to use faster 32-bit multiply-accumulate instructions instead of
okini3939 0:8ba6230eefbd 71 * explicit 64-bit multiply, shift, and add instructions.
okini3939 0:8ba6230eefbd 72 *
okini3939 0:8ba6230eefbd 73 * SSO works like this: a full 32x32->64-bit multiply of two mad_fixed_t
okini3939 0:8ba6230eefbd 74 * values requires the result to be right-shifted 28 bits to be properly
okini3939 0:8ba6230eefbd 75 * scaled to the same fixed-point format. Right shifts can be applied at any
okini3939 0:8ba6230eefbd 76 * time to either operand or to the result, so the optimization involves
okini3939 0:8ba6230eefbd 77 * careful placement of these shifts to minimize the loss of accuracy.
okini3939 0:8ba6230eefbd 78 *
okini3939 0:8ba6230eefbd 79 * First, a 14-bit shift is applied with rounding at compile-time to the D[]
okini3939 0:8ba6230eefbd 80 * table of coefficients for the subband synthesis window. This only loses 2
okini3939 0:8ba6230eefbd 81 * bits of accuracy because the lower 12 bits are always zero. A second
okini3939 0:8ba6230eefbd 82 * 12-bit shift occurs after the DCT calculation. This loses 12 bits of
okini3939 0:8ba6230eefbd 83 * accuracy. Finally, a third 2-bit shift occurs just before the sample is
okini3939 0:8ba6230eefbd 84 * saved in the PCM buffer. 14 + 12 + 2 == 28 bits.
okini3939 0:8ba6230eefbd 85 */
okini3939 0:8ba6230eefbd 86
okini3939 0:8ba6230eefbd 87 /* FPM_DEFAULT without OPT_SSO will actually lose accuracy and performance */
okini3939 0:8ba6230eefbd 88
okini3939 0:8ba6230eefbd 89 # if defined(FPM_DEFAULT) && !defined(OPT_SSO)
okini3939 0:8ba6230eefbd 90 # define OPT_SSO
okini3939 0:8ba6230eefbd 91 # endif
okini3939 0:8ba6230eefbd 92
okini3939 0:8ba6230eefbd 93 /* second SSO shift, with rounding */
okini3939 0:8ba6230eefbd 94
okini3939 0:8ba6230eefbd 95 # if defined(OPT_SSO)
okini3939 0:8ba6230eefbd 96 # define SHIFT(x) (((x) + (1L << 11)) >> 12)
okini3939 0:8ba6230eefbd 97 # else
okini3939 0:8ba6230eefbd 98 # define SHIFT(x) (x)
okini3939 0:8ba6230eefbd 99 # endif
okini3939 0:8ba6230eefbd 100
okini3939 0:8ba6230eefbd 101 /* possible DCT speed optimization */
okini3939 0:8ba6230eefbd 102
okini3939 0:8ba6230eefbd 103 # if defined(OPT_SPEED) && defined(MAD_F_MLX)
okini3939 0:8ba6230eefbd 104 # define OPT_DCTO
okini3939 0:8ba6230eefbd 105 # define MUL(x, y) \
okini3939 0:8ba6230eefbd 106 ({ mad_fixed64hi_t hi; \
okini3939 0:8ba6230eefbd 107 mad_fixed64lo_t lo; \
okini3939 0:8ba6230eefbd 108 MAD_F_MLX(hi, lo, (x), (y)); \
okini3939 0:8ba6230eefbd 109 hi << (32 - MAD_F_SCALEBITS - 3); \
okini3939 0:8ba6230eefbd 110 })
okini3939 0:8ba6230eefbd 111 # else
okini3939 0:8ba6230eefbd 112 # undef OPT_DCTO
okini3939 0:8ba6230eefbd 113 # define MUL(x, y) mad_f_mul((x), (y))
okini3939 0:8ba6230eefbd 114 # endif
okini3939 0:8ba6230eefbd 115
okini3939 0:8ba6230eefbd 116 /*
okini3939 0:8ba6230eefbd 117 * NAME: dct32()
okini3939 0:8ba6230eefbd 118 * DESCRIPTION: perform fast in[32]->out[32] DCT
okini3939 0:8ba6230eefbd 119 */
okini3939 0:8ba6230eefbd 120 static
okini3939 0:8ba6230eefbd 121 void dct32(mad_fixed_t const in[32], unsigned int slot,
okini3939 0:8ba6230eefbd 122 mad_fixed_t lo[16][8], mad_fixed_t hi[16][8])
okini3939 0:8ba6230eefbd 123 {
okini3939 0:8ba6230eefbd 124 mad_fixed_t t0, t1, t2, t3, t4, t5, t6, t7;
okini3939 0:8ba6230eefbd 125 mad_fixed_t t8, t9, t10, t11, t12, t13, t14, t15;
okini3939 0:8ba6230eefbd 126 mad_fixed_t t16, t17, t18, t19, t20, t21, t22, t23;
okini3939 0:8ba6230eefbd 127 mad_fixed_t t24, t25, t26, t27, t28, t29, t30, t31;
okini3939 0:8ba6230eefbd 128 mad_fixed_t t32, t33, t34, t35, t36, t37, t38, t39;
okini3939 0:8ba6230eefbd 129 mad_fixed_t t40, t41, t42, t43, t44, t45, t46, t47;
okini3939 0:8ba6230eefbd 130 mad_fixed_t t48, t49, t50, t51, t52, t53, t54, t55;
okini3939 0:8ba6230eefbd 131 mad_fixed_t t56, t57, t58, t59, t60, t61, t62, t63;
okini3939 0:8ba6230eefbd 132 mad_fixed_t t64, t65, t66, t67, t68, t69, t70, t71;
okini3939 0:8ba6230eefbd 133 mad_fixed_t t72, t73, t74, t75, t76, t77, t78, t79;
okini3939 0:8ba6230eefbd 134 mad_fixed_t t80, t81, t82, t83, t84, t85, t86, t87;
okini3939 0:8ba6230eefbd 135 mad_fixed_t t88, t89, t90, t91, t92, t93, t94, t95;
okini3939 0:8ba6230eefbd 136 mad_fixed_t t96, t97, t98, t99, t100, t101, t102, t103;
okini3939 0:8ba6230eefbd 137 mad_fixed_t t104, t105, t106, t107, t108, t109, t110, t111;
okini3939 0:8ba6230eefbd 138 mad_fixed_t t112, t113, t114, t115, t116, t117, t118, t119;
okini3939 0:8ba6230eefbd 139 mad_fixed_t t120, t121, t122, t123, t124, t125, t126, t127;
okini3939 0:8ba6230eefbd 140 mad_fixed_t t128, t129, t130, t131, t132, t133, t134, t135;
okini3939 0:8ba6230eefbd 141 mad_fixed_t t136, t137, t138, t139, t140, t141, t142, t143;
okini3939 0:8ba6230eefbd 142 mad_fixed_t t144, t145, t146, t147, t148, t149, t150, t151;
okini3939 0:8ba6230eefbd 143 mad_fixed_t t152, t153, t154, t155, t156, t157, t158, t159;
okini3939 0:8ba6230eefbd 144 mad_fixed_t t160, t161, t162, t163, t164, t165, t166, t167;
okini3939 0:8ba6230eefbd 145 mad_fixed_t t168, t169, t170, t171, t172, t173, t174, t175;
okini3939 0:8ba6230eefbd 146 mad_fixed_t t176;
okini3939 0:8ba6230eefbd 147
okini3939 0:8ba6230eefbd 148 /* costab[i] = cos(PI / (2 * 32) * i) */
okini3939 0:8ba6230eefbd 149
okini3939 0:8ba6230eefbd 150 # if defined(OPT_DCTO)
okini3939 0:8ba6230eefbd 151 # define costab1 MAD_F(0x7fd8878e)
okini3939 0:8ba6230eefbd 152 # define costab2 MAD_F(0x7f62368f)
okini3939 0:8ba6230eefbd 153 # define costab3 MAD_F(0x7e9d55fc)
okini3939 0:8ba6230eefbd 154 # define costab4 MAD_F(0x7d8a5f40)
okini3939 0:8ba6230eefbd 155 # define costab5 MAD_F(0x7c29fbee)
okini3939 0:8ba6230eefbd 156 # define costab6 MAD_F(0x7a7d055b)
okini3939 0:8ba6230eefbd 157 # define costab7 MAD_F(0x78848414)
okini3939 0:8ba6230eefbd 158 # define costab8 MAD_F(0x7641af3d)
okini3939 0:8ba6230eefbd 159 # define costab9 MAD_F(0x73b5ebd1)
okini3939 0:8ba6230eefbd 160 # define costab10 MAD_F(0x70e2cbc6)
okini3939 0:8ba6230eefbd 161 # define costab11 MAD_F(0x6dca0d14)
okini3939 0:8ba6230eefbd 162 # define costab12 MAD_F(0x6a6d98a4)
okini3939 0:8ba6230eefbd 163 # define costab13 MAD_F(0x66cf8120)
okini3939 0:8ba6230eefbd 164 # define costab14 MAD_F(0x62f201ac)
okini3939 0:8ba6230eefbd 165 # define costab15 MAD_F(0x5ed77c8a)
okini3939 0:8ba6230eefbd 166 # define costab16 MAD_F(0x5a82799a)
okini3939 0:8ba6230eefbd 167 # define costab17 MAD_F(0x55f5a4d2)
okini3939 0:8ba6230eefbd 168 # define costab18 MAD_F(0x5133cc94)
okini3939 0:8ba6230eefbd 169 # define costab19 MAD_F(0x4c3fdff4)
okini3939 0:8ba6230eefbd 170 # define costab20 MAD_F(0x471cece7)
okini3939 0:8ba6230eefbd 171 # define costab21 MAD_F(0x41ce1e65)
okini3939 0:8ba6230eefbd 172 # define costab22 MAD_F(0x3c56ba70)
okini3939 0:8ba6230eefbd 173 # define costab23 MAD_F(0x36ba2014)
okini3939 0:8ba6230eefbd 174 # define costab24 MAD_F(0x30fbc54d)
okini3939 0:8ba6230eefbd 175 # define costab25 MAD_F(0x2b1f34eb)
okini3939 0:8ba6230eefbd 176 # define costab26 MAD_F(0x25280c5e)
okini3939 0:8ba6230eefbd 177 # define costab27 MAD_F(0x1f19f97b)
okini3939 0:8ba6230eefbd 178 # define costab28 MAD_F(0x18f8b83c)
okini3939 0:8ba6230eefbd 179 # define costab29 MAD_F(0x12c8106f)
okini3939 0:8ba6230eefbd 180 # define costab30 MAD_F(0x0c8bd35e)
okini3939 0:8ba6230eefbd 181 # define costab31 MAD_F(0x0647d97c)
okini3939 0:8ba6230eefbd 182 # else
okini3939 0:8ba6230eefbd 183 # define costab1 MAD_F(0x0ffb10f2) /* 0.998795456 */
okini3939 0:8ba6230eefbd 184 # define costab2 MAD_F(0x0fec46d2) /* 0.995184727 */
okini3939 0:8ba6230eefbd 185 # define costab3 MAD_F(0x0fd3aac0) /* 0.989176510 */
okini3939 0:8ba6230eefbd 186 # define costab4 MAD_F(0x0fb14be8) /* 0.980785280 */
okini3939 0:8ba6230eefbd 187 # define costab5 MAD_F(0x0f853f7e) /* 0.970031253 */
okini3939 0:8ba6230eefbd 188 # define costab6 MAD_F(0x0f4fa0ab) /* 0.956940336 */
okini3939 0:8ba6230eefbd 189 # define costab7 MAD_F(0x0f109082) /* 0.941544065 */
okini3939 0:8ba6230eefbd 190 # define costab8 MAD_F(0x0ec835e8) /* 0.923879533 */
okini3939 0:8ba6230eefbd 191 # define costab9 MAD_F(0x0e76bd7a) /* 0.903989293 */
okini3939 0:8ba6230eefbd 192 # define costab10 MAD_F(0x0e1c5979) /* 0.881921264 */
okini3939 0:8ba6230eefbd 193 # define costab11 MAD_F(0x0db941a3) /* 0.857728610 */
okini3939 0:8ba6230eefbd 194 # define costab12 MAD_F(0x0d4db315) /* 0.831469612 */
okini3939 0:8ba6230eefbd 195 # define costab13 MAD_F(0x0cd9f024) /* 0.803207531 */
okini3939 0:8ba6230eefbd 196 # define costab14 MAD_F(0x0c5e4036) /* 0.773010453 */
okini3939 0:8ba6230eefbd 197 # define costab15 MAD_F(0x0bdaef91) /* 0.740951125 */
okini3939 0:8ba6230eefbd 198 # define costab16 MAD_F(0x0b504f33) /* 0.707106781 */
okini3939 0:8ba6230eefbd 199 # define costab17 MAD_F(0x0abeb49a) /* 0.671558955 */
okini3939 0:8ba6230eefbd 200 # define costab18 MAD_F(0x0a267993) /* 0.634393284 */
okini3939 0:8ba6230eefbd 201 # define costab19 MAD_F(0x0987fbfe) /* 0.595699304 */
okini3939 0:8ba6230eefbd 202 # define costab20 MAD_F(0x08e39d9d) /* 0.555570233 */
okini3939 0:8ba6230eefbd 203 # define costab21 MAD_F(0x0839c3cd) /* 0.514102744 */
okini3939 0:8ba6230eefbd 204 # define costab22 MAD_F(0x078ad74e) /* 0.471396737 */
okini3939 0:8ba6230eefbd 205 # define costab23 MAD_F(0x06d74402) /* 0.427555093 */
okini3939 0:8ba6230eefbd 206 # define costab24 MAD_F(0x061f78aa) /* 0.382683432 */
okini3939 0:8ba6230eefbd 207 # define costab25 MAD_F(0x0563e69d) /* 0.336889853 */
okini3939 0:8ba6230eefbd 208 # define costab26 MAD_F(0x04a5018c) /* 0.290284677 */
okini3939 0:8ba6230eefbd 209 # define costab27 MAD_F(0x03e33f2f) /* 0.242980180 */
okini3939 0:8ba6230eefbd 210 # define costab28 MAD_F(0x031f1708) /* 0.195090322 */
okini3939 0:8ba6230eefbd 211 # define costab29 MAD_F(0x0259020e) /* 0.146730474 */
okini3939 0:8ba6230eefbd 212 # define costab30 MAD_F(0x01917a6c) /* 0.098017140 */
okini3939 0:8ba6230eefbd 213 # define costab31 MAD_F(0x00c8fb30) /* 0.049067674 */
okini3939 0:8ba6230eefbd 214 # endif
okini3939 0:8ba6230eefbd 215
okini3939 0:8ba6230eefbd 216 t0 = in[0] + in[31]; t16 = MUL(in[0] - in[31], costab1);
okini3939 0:8ba6230eefbd 217 t1 = in[15] + in[16]; t17 = MUL(in[15] - in[16], costab31);
okini3939 0:8ba6230eefbd 218
okini3939 0:8ba6230eefbd 219 t41 = t16 + t17;
okini3939 0:8ba6230eefbd 220 t59 = MUL(t16 - t17, costab2);
okini3939 0:8ba6230eefbd 221 t33 = t0 + t1;
okini3939 0:8ba6230eefbd 222 t50 = MUL(t0 - t1, costab2);
okini3939 0:8ba6230eefbd 223
okini3939 0:8ba6230eefbd 224 t2 = in[7] + in[24]; t18 = MUL(in[7] - in[24], costab15);
okini3939 0:8ba6230eefbd 225 t3 = in[8] + in[23]; t19 = MUL(in[8] - in[23], costab17);
okini3939 0:8ba6230eefbd 226
okini3939 0:8ba6230eefbd 227 t42 = t18 + t19;
okini3939 0:8ba6230eefbd 228 t60 = MUL(t18 - t19, costab30);
okini3939 0:8ba6230eefbd 229 t34 = t2 + t3;
okini3939 0:8ba6230eefbd 230 t51 = MUL(t2 - t3, costab30);
okini3939 0:8ba6230eefbd 231
okini3939 0:8ba6230eefbd 232 t4 = in[3] + in[28]; t20 = MUL(in[3] - in[28], costab7);
okini3939 0:8ba6230eefbd 233 t5 = in[12] + in[19]; t21 = MUL(in[12] - in[19], costab25);
okini3939 0:8ba6230eefbd 234
okini3939 0:8ba6230eefbd 235 t43 = t20 + t21;
okini3939 0:8ba6230eefbd 236 t61 = MUL(t20 - t21, costab14);
okini3939 0:8ba6230eefbd 237 t35 = t4 + t5;
okini3939 0:8ba6230eefbd 238 t52 = MUL(t4 - t5, costab14);
okini3939 0:8ba6230eefbd 239
okini3939 0:8ba6230eefbd 240 t6 = in[4] + in[27]; t22 = MUL(in[4] - in[27], costab9);
okini3939 0:8ba6230eefbd 241 t7 = in[11] + in[20]; t23 = MUL(in[11] - in[20], costab23);
okini3939 0:8ba6230eefbd 242
okini3939 0:8ba6230eefbd 243 t44 = t22 + t23;
okini3939 0:8ba6230eefbd 244 t62 = MUL(t22 - t23, costab18);
okini3939 0:8ba6230eefbd 245 t36 = t6 + t7;
okini3939 0:8ba6230eefbd 246 t53 = MUL(t6 - t7, costab18);
okini3939 0:8ba6230eefbd 247
okini3939 0:8ba6230eefbd 248 t8 = in[1] + in[30]; t24 = MUL(in[1] - in[30], costab3);
okini3939 0:8ba6230eefbd 249 t9 = in[14] + in[17]; t25 = MUL(in[14] - in[17], costab29);
okini3939 0:8ba6230eefbd 250
okini3939 0:8ba6230eefbd 251 t45 = t24 + t25;
okini3939 0:8ba6230eefbd 252 t63 = MUL(t24 - t25, costab6);
okini3939 0:8ba6230eefbd 253 t37 = t8 + t9;
okini3939 0:8ba6230eefbd 254 t54 = MUL(t8 - t9, costab6);
okini3939 0:8ba6230eefbd 255
okini3939 0:8ba6230eefbd 256 t10 = in[6] + in[25]; t26 = MUL(in[6] - in[25], costab13);
okini3939 0:8ba6230eefbd 257 t11 = in[9] + in[22]; t27 = MUL(in[9] - in[22], costab19);
okini3939 0:8ba6230eefbd 258
okini3939 0:8ba6230eefbd 259 t46 = t26 + t27;
okini3939 0:8ba6230eefbd 260 t64 = MUL(t26 - t27, costab26);
okini3939 0:8ba6230eefbd 261 t38 = t10 + t11;
okini3939 0:8ba6230eefbd 262 t55 = MUL(t10 - t11, costab26);
okini3939 0:8ba6230eefbd 263
okini3939 0:8ba6230eefbd 264 t12 = in[2] + in[29]; t28 = MUL(in[2] - in[29], costab5);
okini3939 0:8ba6230eefbd 265 t13 = in[13] + in[18]; t29 = MUL(in[13] - in[18], costab27);
okini3939 0:8ba6230eefbd 266
okini3939 0:8ba6230eefbd 267 t47 = t28 + t29;
okini3939 0:8ba6230eefbd 268 t65 = MUL(t28 - t29, costab10);
okini3939 0:8ba6230eefbd 269 t39 = t12 + t13;
okini3939 0:8ba6230eefbd 270 t56 = MUL(t12 - t13, costab10);
okini3939 0:8ba6230eefbd 271
okini3939 0:8ba6230eefbd 272 t14 = in[5] + in[26]; t30 = MUL(in[5] - in[26], costab11);
okini3939 0:8ba6230eefbd 273 t15 = in[10] + in[21]; t31 = MUL(in[10] - in[21], costab21);
okini3939 0:8ba6230eefbd 274
okini3939 0:8ba6230eefbd 275 t48 = t30 + t31;
okini3939 0:8ba6230eefbd 276 t66 = MUL(t30 - t31, costab22);
okini3939 0:8ba6230eefbd 277 t40 = t14 + t15;
okini3939 0:8ba6230eefbd 278 t57 = MUL(t14 - t15, costab22);
okini3939 0:8ba6230eefbd 279
okini3939 0:8ba6230eefbd 280 t69 = t33 + t34; t89 = MUL(t33 - t34, costab4);
okini3939 0:8ba6230eefbd 281 t70 = t35 + t36; t90 = MUL(t35 - t36, costab28);
okini3939 0:8ba6230eefbd 282 t71 = t37 + t38; t91 = MUL(t37 - t38, costab12);
okini3939 0:8ba6230eefbd 283 t72 = t39 + t40; t92 = MUL(t39 - t40, costab20);
okini3939 0:8ba6230eefbd 284 t73 = t41 + t42; t94 = MUL(t41 - t42, costab4);
okini3939 0:8ba6230eefbd 285 t74 = t43 + t44; t95 = MUL(t43 - t44, costab28);
okini3939 0:8ba6230eefbd 286 t75 = t45 + t46; t96 = MUL(t45 - t46, costab12);
okini3939 0:8ba6230eefbd 287 t76 = t47 + t48; t97 = MUL(t47 - t48, costab20);
okini3939 0:8ba6230eefbd 288
okini3939 0:8ba6230eefbd 289 t78 = t50 + t51; t100 = MUL(t50 - t51, costab4);
okini3939 0:8ba6230eefbd 290 t79 = t52 + t53; t101 = MUL(t52 - t53, costab28);
okini3939 0:8ba6230eefbd 291 t80 = t54 + t55; t102 = MUL(t54 - t55, costab12);
okini3939 0:8ba6230eefbd 292 t81 = t56 + t57; t103 = MUL(t56 - t57, costab20);
okini3939 0:8ba6230eefbd 293
okini3939 0:8ba6230eefbd 294 t83 = t59 + t60; t106 = MUL(t59 - t60, costab4);
okini3939 0:8ba6230eefbd 295 t84 = t61 + t62; t107 = MUL(t61 - t62, costab28);
okini3939 0:8ba6230eefbd 296 t85 = t63 + t64; t108 = MUL(t63 - t64, costab12);
okini3939 0:8ba6230eefbd 297 t86 = t65 + t66; t109 = MUL(t65 - t66, costab20);
okini3939 0:8ba6230eefbd 298
okini3939 0:8ba6230eefbd 299 t113 = t69 + t70;
okini3939 0:8ba6230eefbd 300 t114 = t71 + t72;
okini3939 0:8ba6230eefbd 301
okini3939 0:8ba6230eefbd 302 /* 0 */ hi[15][slot] = SHIFT(t113 + t114);
okini3939 0:8ba6230eefbd 303 /* 16 */ lo[ 0][slot] = SHIFT(MUL(t113 - t114, costab16));
okini3939 0:8ba6230eefbd 304
okini3939 0:8ba6230eefbd 305 t115 = t73 + t74;
okini3939 0:8ba6230eefbd 306 t116 = t75 + t76;
okini3939 0:8ba6230eefbd 307
okini3939 0:8ba6230eefbd 308 t32 = t115 + t116;
okini3939 0:8ba6230eefbd 309
okini3939 0:8ba6230eefbd 310 /* 1 */ hi[14][slot] = SHIFT(t32);
okini3939 0:8ba6230eefbd 311
okini3939 0:8ba6230eefbd 312 t118 = t78 + t79;
okini3939 0:8ba6230eefbd 313 t119 = t80 + t81;
okini3939 0:8ba6230eefbd 314
okini3939 0:8ba6230eefbd 315 t58 = t118 + t119;
okini3939 0:8ba6230eefbd 316
okini3939 0:8ba6230eefbd 317 /* 2 */ hi[13][slot] = SHIFT(t58);
okini3939 0:8ba6230eefbd 318
okini3939 0:8ba6230eefbd 319 t121 = t83 + t84;
okini3939 0:8ba6230eefbd 320 t122 = t85 + t86;
okini3939 0:8ba6230eefbd 321
okini3939 0:8ba6230eefbd 322 t67 = t121 + t122;
okini3939 0:8ba6230eefbd 323
okini3939 0:8ba6230eefbd 324 t49 = (t67 * 2) - t32;
okini3939 0:8ba6230eefbd 325
okini3939 0:8ba6230eefbd 326 /* 3 */ hi[12][slot] = SHIFT(t49);
okini3939 0:8ba6230eefbd 327
okini3939 0:8ba6230eefbd 328 t125 = t89 + t90;
okini3939 0:8ba6230eefbd 329 t126 = t91 + t92;
okini3939 0:8ba6230eefbd 330
okini3939 0:8ba6230eefbd 331 t93 = t125 + t126;
okini3939 0:8ba6230eefbd 332
okini3939 0:8ba6230eefbd 333 /* 4 */ hi[11][slot] = SHIFT(t93);
okini3939 0:8ba6230eefbd 334
okini3939 0:8ba6230eefbd 335 t128 = t94 + t95;
okini3939 0:8ba6230eefbd 336 t129 = t96 + t97;
okini3939 0:8ba6230eefbd 337
okini3939 0:8ba6230eefbd 338 t98 = t128 + t129;
okini3939 0:8ba6230eefbd 339
okini3939 0:8ba6230eefbd 340 t68 = (t98 * 2) - t49;
okini3939 0:8ba6230eefbd 341
okini3939 0:8ba6230eefbd 342 /* 5 */ hi[10][slot] = SHIFT(t68);
okini3939 0:8ba6230eefbd 343
okini3939 0:8ba6230eefbd 344 t132 = t100 + t101;
okini3939 0:8ba6230eefbd 345 t133 = t102 + t103;
okini3939 0:8ba6230eefbd 346
okini3939 0:8ba6230eefbd 347 t104 = t132 + t133;
okini3939 0:8ba6230eefbd 348
okini3939 0:8ba6230eefbd 349 t82 = (t104 * 2) - t58;
okini3939 0:8ba6230eefbd 350
okini3939 0:8ba6230eefbd 351 /* 6 */ hi[ 9][slot] = SHIFT(t82);
okini3939 0:8ba6230eefbd 352
okini3939 0:8ba6230eefbd 353 t136 = t106 + t107;
okini3939 0:8ba6230eefbd 354 t137 = t108 + t109;
okini3939 0:8ba6230eefbd 355
okini3939 0:8ba6230eefbd 356 t110 = t136 + t137;
okini3939 0:8ba6230eefbd 357
okini3939 0:8ba6230eefbd 358 t87 = (t110 * 2) - t67;
okini3939 0:8ba6230eefbd 359
okini3939 0:8ba6230eefbd 360 t77 = (t87 * 2) - t68;
okini3939 0:8ba6230eefbd 361
okini3939 0:8ba6230eefbd 362 /* 7 */ hi[ 8][slot] = SHIFT(t77);
okini3939 0:8ba6230eefbd 363
okini3939 0:8ba6230eefbd 364 t141 = MUL(t69 - t70, costab8);
okini3939 0:8ba6230eefbd 365 t142 = MUL(t71 - t72, costab24);
okini3939 0:8ba6230eefbd 366 t143 = t141 + t142;
okini3939 0:8ba6230eefbd 367
okini3939 0:8ba6230eefbd 368 /* 8 */ hi[ 7][slot] = SHIFT(t143);
okini3939 0:8ba6230eefbd 369 /* 24 */ lo[ 8][slot] =
okini3939 0:8ba6230eefbd 370 SHIFT((MUL(t141 - t142, costab16) * 2) - t143);
okini3939 0:8ba6230eefbd 371
okini3939 0:8ba6230eefbd 372 t144 = MUL(t73 - t74, costab8);
okini3939 0:8ba6230eefbd 373 t145 = MUL(t75 - t76, costab24);
okini3939 0:8ba6230eefbd 374 t146 = t144 + t145;
okini3939 0:8ba6230eefbd 375
okini3939 0:8ba6230eefbd 376 t88 = (t146 * 2) - t77;
okini3939 0:8ba6230eefbd 377
okini3939 0:8ba6230eefbd 378 /* 9 */ hi[ 6][slot] = SHIFT(t88);
okini3939 0:8ba6230eefbd 379
okini3939 0:8ba6230eefbd 380 t148 = MUL(t78 - t79, costab8);
okini3939 0:8ba6230eefbd 381 t149 = MUL(t80 - t81, costab24);
okini3939 0:8ba6230eefbd 382 t150 = t148 + t149;
okini3939 0:8ba6230eefbd 383
okini3939 0:8ba6230eefbd 384 t105 = (t150 * 2) - t82;
okini3939 0:8ba6230eefbd 385
okini3939 0:8ba6230eefbd 386 /* 10 */ hi[ 5][slot] = SHIFT(t105);
okini3939 0:8ba6230eefbd 387
okini3939 0:8ba6230eefbd 388 t152 = MUL(t83 - t84, costab8);
okini3939 0:8ba6230eefbd 389 t153 = MUL(t85 - t86, costab24);
okini3939 0:8ba6230eefbd 390 t154 = t152 + t153;
okini3939 0:8ba6230eefbd 391
okini3939 0:8ba6230eefbd 392 t111 = (t154 * 2) - t87;
okini3939 0:8ba6230eefbd 393
okini3939 0:8ba6230eefbd 394 t99 = (t111 * 2) - t88;
okini3939 0:8ba6230eefbd 395
okini3939 0:8ba6230eefbd 396 /* 11 */ hi[ 4][slot] = SHIFT(t99);
okini3939 0:8ba6230eefbd 397
okini3939 0:8ba6230eefbd 398 t157 = MUL(t89 - t90, costab8);
okini3939 0:8ba6230eefbd 399 t158 = MUL(t91 - t92, costab24);
okini3939 0:8ba6230eefbd 400 t159 = t157 + t158;
okini3939 0:8ba6230eefbd 401
okini3939 0:8ba6230eefbd 402 t127 = (t159 * 2) - t93;
okini3939 0:8ba6230eefbd 403
okini3939 0:8ba6230eefbd 404 /* 12 */ hi[ 3][slot] = SHIFT(t127);
okini3939 0:8ba6230eefbd 405
okini3939 0:8ba6230eefbd 406 t160 = (MUL(t125 - t126, costab16) * 2) - t127;
okini3939 0:8ba6230eefbd 407
okini3939 0:8ba6230eefbd 408 /* 20 */ lo[ 4][slot] = SHIFT(t160);
okini3939 0:8ba6230eefbd 409 /* 28 */ lo[12][slot] =
okini3939 0:8ba6230eefbd 410 SHIFT((((MUL(t157 - t158, costab16) * 2) - t159) * 2) - t160);
okini3939 0:8ba6230eefbd 411
okini3939 0:8ba6230eefbd 412 t161 = MUL(t94 - t95, costab8);
okini3939 0:8ba6230eefbd 413 t162 = MUL(t96 - t97, costab24);
okini3939 0:8ba6230eefbd 414 t163 = t161 + t162;
okini3939 0:8ba6230eefbd 415
okini3939 0:8ba6230eefbd 416 t130 = (t163 * 2) - t98;
okini3939 0:8ba6230eefbd 417
okini3939 0:8ba6230eefbd 418 t112 = (t130 * 2) - t99;
okini3939 0:8ba6230eefbd 419
okini3939 0:8ba6230eefbd 420 /* 13 */ hi[ 2][slot] = SHIFT(t112);
okini3939 0:8ba6230eefbd 421
okini3939 0:8ba6230eefbd 422 t164 = (MUL(t128 - t129, costab16) * 2) - t130;
okini3939 0:8ba6230eefbd 423
okini3939 0:8ba6230eefbd 424 t166 = MUL(t100 - t101, costab8);
okini3939 0:8ba6230eefbd 425 t167 = MUL(t102 - t103, costab24);
okini3939 0:8ba6230eefbd 426 t168 = t166 + t167;
okini3939 0:8ba6230eefbd 427
okini3939 0:8ba6230eefbd 428 t134 = (t168 * 2) - t104;
okini3939 0:8ba6230eefbd 429
okini3939 0:8ba6230eefbd 430 t120 = (t134 * 2) - t105;
okini3939 0:8ba6230eefbd 431
okini3939 0:8ba6230eefbd 432 /* 14 */ hi[ 1][slot] = SHIFT(t120);
okini3939 0:8ba6230eefbd 433
okini3939 0:8ba6230eefbd 434 t135 = (MUL(t118 - t119, costab16) * 2) - t120;
okini3939 0:8ba6230eefbd 435
okini3939 0:8ba6230eefbd 436 /* 18 */ lo[ 2][slot] = SHIFT(t135);
okini3939 0:8ba6230eefbd 437
okini3939 0:8ba6230eefbd 438 t169 = (MUL(t132 - t133, costab16) * 2) - t134;
okini3939 0:8ba6230eefbd 439
okini3939 0:8ba6230eefbd 440 t151 = (t169 * 2) - t135;
okini3939 0:8ba6230eefbd 441
okini3939 0:8ba6230eefbd 442 /* 22 */ lo[ 6][slot] = SHIFT(t151);
okini3939 0:8ba6230eefbd 443
okini3939 0:8ba6230eefbd 444 t170 = (((MUL(t148 - t149, costab16) * 2) - t150) * 2) - t151;
okini3939 0:8ba6230eefbd 445
okini3939 0:8ba6230eefbd 446 /* 26 */ lo[10][slot] = SHIFT(t170);
okini3939 0:8ba6230eefbd 447 /* 30 */ lo[14][slot] =
okini3939 0:8ba6230eefbd 448 SHIFT((((((MUL(t166 - t167, costab16) * 2) -
okini3939 0:8ba6230eefbd 449 t168) * 2) - t169) * 2) - t170);
okini3939 0:8ba6230eefbd 450
okini3939 0:8ba6230eefbd 451 t171 = MUL(t106 - t107, costab8);
okini3939 0:8ba6230eefbd 452 t172 = MUL(t108 - t109, costab24);
okini3939 0:8ba6230eefbd 453 t173 = t171 + t172;
okini3939 0:8ba6230eefbd 454
okini3939 0:8ba6230eefbd 455 t138 = (t173 * 2) - t110;
okini3939 0:8ba6230eefbd 456
okini3939 0:8ba6230eefbd 457 t123 = (t138 * 2) - t111;
okini3939 0:8ba6230eefbd 458
okini3939 0:8ba6230eefbd 459 t139 = (MUL(t121 - t122, costab16) * 2) - t123;
okini3939 0:8ba6230eefbd 460
okini3939 0:8ba6230eefbd 461 t117 = (t123 * 2) - t112;
okini3939 0:8ba6230eefbd 462
okini3939 0:8ba6230eefbd 463 /* 15 */ hi[ 0][slot] = SHIFT(t117);
okini3939 0:8ba6230eefbd 464
okini3939 0:8ba6230eefbd 465 t124 = (MUL(t115 - t116, costab16) * 2) - t117;
okini3939 0:8ba6230eefbd 466
okini3939 0:8ba6230eefbd 467 /* 17 */ lo[ 1][slot] = SHIFT(t124);
okini3939 0:8ba6230eefbd 468
okini3939 0:8ba6230eefbd 469 t131 = (t139 * 2) - t124;
okini3939 0:8ba6230eefbd 470
okini3939 0:8ba6230eefbd 471 /* 19 */ lo[ 3][slot] = SHIFT(t131);
okini3939 0:8ba6230eefbd 472
okini3939 0:8ba6230eefbd 473 t140 = (t164 * 2) - t131;
okini3939 0:8ba6230eefbd 474
okini3939 0:8ba6230eefbd 475 /* 21 */ lo[ 5][slot] = SHIFT(t140);
okini3939 0:8ba6230eefbd 476
okini3939 0:8ba6230eefbd 477 t174 = (MUL(t136 - t137, costab16) * 2) - t138;
okini3939 0:8ba6230eefbd 478
okini3939 0:8ba6230eefbd 479 t155 = (t174 * 2) - t139;
okini3939 0:8ba6230eefbd 480
okini3939 0:8ba6230eefbd 481 t147 = (t155 * 2) - t140;
okini3939 0:8ba6230eefbd 482
okini3939 0:8ba6230eefbd 483 /* 23 */ lo[ 7][slot] = SHIFT(t147);
okini3939 0:8ba6230eefbd 484
okini3939 0:8ba6230eefbd 485 t156 = (((MUL(t144 - t145, costab16) * 2) - t146) * 2) - t147;
okini3939 0:8ba6230eefbd 486
okini3939 0:8ba6230eefbd 487 /* 25 */ lo[ 9][slot] = SHIFT(t156);
okini3939 0:8ba6230eefbd 488
okini3939 0:8ba6230eefbd 489 t175 = (((MUL(t152 - t153, costab16) * 2) - t154) * 2) - t155;
okini3939 0:8ba6230eefbd 490
okini3939 0:8ba6230eefbd 491 t165 = (t175 * 2) - t156;
okini3939 0:8ba6230eefbd 492
okini3939 0:8ba6230eefbd 493 /* 27 */ lo[11][slot] = SHIFT(t165);
okini3939 0:8ba6230eefbd 494
okini3939 0:8ba6230eefbd 495 t176 = (((((MUL(t161 - t162, costab16) * 2) -
okini3939 0:8ba6230eefbd 496 t163) * 2) - t164) * 2) - t165;
okini3939 0:8ba6230eefbd 497
okini3939 0:8ba6230eefbd 498 /* 29 */ lo[13][slot] = SHIFT(t176);
okini3939 0:8ba6230eefbd 499 /* 31 */ lo[15][slot] =
okini3939 0:8ba6230eefbd 500 SHIFT((((((((MUL(t171 - t172, costab16) * 2) -
okini3939 0:8ba6230eefbd 501 t173) * 2) - t174) * 2) - t175) * 2) - t176);
okini3939 0:8ba6230eefbd 502
okini3939 0:8ba6230eefbd 503 /*
okini3939 0:8ba6230eefbd 504 * Totals:
okini3939 0:8ba6230eefbd 505 * 80 multiplies
okini3939 0:8ba6230eefbd 506 * 80 additions
okini3939 0:8ba6230eefbd 507 * 119 subtractions
okini3939 0:8ba6230eefbd 508 * 49 shifts (not counting SSO)
okini3939 0:8ba6230eefbd 509 */
okini3939 0:8ba6230eefbd 510 }
okini3939 0:8ba6230eefbd 511
okini3939 0:8ba6230eefbd 512 # undef MUL
okini3939 0:8ba6230eefbd 513 # undef SHIFT
okini3939 0:8ba6230eefbd 514
okini3939 0:8ba6230eefbd 515 /* third SSO shift and/or D[] optimization preshift */
okini3939 0:8ba6230eefbd 516
okini3939 0:8ba6230eefbd 517 # if defined(OPT_SSO)
okini3939 0:8ba6230eefbd 518 # if MAD_F_FRACBITS != 28
okini3939 0:8ba6230eefbd 519 # error "MAD_F_FRACBITS must be 28 to use OPT_SSO"
okini3939 0:8ba6230eefbd 520 # endif
okini3939 0:8ba6230eefbd 521 # define ML0(hi, lo, x, y) ((lo) = (x) * (y))
okini3939 0:8ba6230eefbd 522 # define MLA(hi, lo, x, y) ((lo) += (x) * (y))
okini3939 0:8ba6230eefbd 523 # define MLN(hi, lo) ((lo) = -(lo))
okini3939 0:8ba6230eefbd 524 # define MLZ(hi, lo) ((void) (hi), (mad_fixed_t) (lo))
okini3939 0:8ba6230eefbd 525 # define SHIFT(x) ((x) >> 2)
okini3939 0:8ba6230eefbd 526 # define PRESHIFT(x) ((MAD_F(x) + (1L << 13)) >> 14)
okini3939 0:8ba6230eefbd 527 # else
okini3939 0:8ba6230eefbd 528 # define ML0(hi, lo, x, y) MAD_F_ML0((hi), (lo), (x), (y))
okini3939 0:8ba6230eefbd 529 # define MLA(hi, lo, x, y) MAD_F_MLA((hi), (lo), (x), (y))
okini3939 0:8ba6230eefbd 530 # define MLN(hi, lo) MAD_F_MLN((hi), (lo))
okini3939 0:8ba6230eefbd 531 # define MLZ(hi, lo) MAD_F_MLZ((hi), (lo))
okini3939 0:8ba6230eefbd 532 # define SHIFT(x) (x)
okini3939 0:8ba6230eefbd 533 # if defined(MAD_F_SCALEBITS)
okini3939 0:8ba6230eefbd 534 # undef MAD_F_SCALEBITS
okini3939 0:8ba6230eefbd 535 # define MAD_F_SCALEBITS (MAD_F_FRACBITS - 12)
okini3939 0:8ba6230eefbd 536 # define PRESHIFT(x) (MAD_F(x) >> 12)
okini3939 0:8ba6230eefbd 537 # else
okini3939 0:8ba6230eefbd 538 # define PRESHIFT(x) MAD_F(x)
okini3939 0:8ba6230eefbd 539 # endif
okini3939 0:8ba6230eefbd 540 # endif
okini3939 0:8ba6230eefbd 541
okini3939 0:8ba6230eefbd 542 static
okini3939 0:8ba6230eefbd 543 mad_fixed_t const D[17][32] = {
okini3939 0:8ba6230eefbd 544 # include "d.h"
okini3939 0:8ba6230eefbd 545 };
okini3939 0:8ba6230eefbd 546
okini3939 0:8ba6230eefbd 547 # if defined(ASO_SYNTH)
okini3939 0:8ba6230eefbd 548 void synth_full(struct mad_synth *, struct mad_frame const *,
okini3939 0:8ba6230eefbd 549 unsigned int, unsigned int);
okini3939 0:8ba6230eefbd 550 # else
okini3939 0:8ba6230eefbd 551 /*
okini3939 0:8ba6230eefbd 552 * NAME: synth->full()
okini3939 0:8ba6230eefbd 553 * DESCRIPTION: perform full frequency PCM synthesis
okini3939 0:8ba6230eefbd 554 */
okini3939 0:8ba6230eefbd 555 static
okini3939 0:8ba6230eefbd 556 void synth_full(struct mad_synth *synth, struct mad_frame const *frame,
okini3939 0:8ba6230eefbd 557 unsigned int nch, unsigned int ns)
okini3939 0:8ba6230eefbd 558 {
okini3939 0:8ba6230eefbd 559 unsigned int phase, ch, s, sb, pe, po;
okini3939 0:8ba6230eefbd 560 mad_fixed_t *pcm1, *pcm2, (*filter)[2][2][16][8];
okini3939 0:8ba6230eefbd 561 mad_fixed_t const (*sbsample)[36][32];
okini3939 0:8ba6230eefbd 562 register mad_fixed_t (*fe)[8], (*fx)[8], (*fo)[8];
okini3939 0:8ba6230eefbd 563 register mad_fixed_t const (*Dptr)[32], *ptr;
okini3939 0:8ba6230eefbd 564 register mad_fixed64hi_t hi;
okini3939 0:8ba6230eefbd 565 register mad_fixed64lo_t lo;
okini3939 0:8ba6230eefbd 566
okini3939 0:8ba6230eefbd 567 for (ch = 0; ch < nch; ++ch) {
okini3939 0:8ba6230eefbd 568 sbsample = &frame->sbsample[ch];
okini3939 0:8ba6230eefbd 569 filter = &synth->filter[ch];
okini3939 0:8ba6230eefbd 570 phase = synth->phase;
okini3939 0:8ba6230eefbd 571 pcm1 = synth->pcm.samples[ch];
okini3939 0:8ba6230eefbd 572
okini3939 0:8ba6230eefbd 573 for (s = 0; s < ns; ++s) {
okini3939 0:8ba6230eefbd 574 dct32((*sbsample)[s], phase >> 1,
okini3939 0:8ba6230eefbd 575 (*filter)[0][phase & 1], (*filter)[1][phase & 1]);
okini3939 0:8ba6230eefbd 576
okini3939 0:8ba6230eefbd 577 pe = phase & ~1;
okini3939 0:8ba6230eefbd 578 po = ((phase - 1) & 0xf) | 1;
okini3939 0:8ba6230eefbd 579
okini3939 0:8ba6230eefbd 580 /* calculate 32 samples */
okini3939 0:8ba6230eefbd 581
okini3939 0:8ba6230eefbd 582 fe = &(*filter)[0][ phase & 1][0];
okini3939 0:8ba6230eefbd 583 fx = &(*filter)[0][~phase & 1][0];
okini3939 0:8ba6230eefbd 584 fo = &(*filter)[1][~phase & 1][0];
okini3939 0:8ba6230eefbd 585
okini3939 0:8ba6230eefbd 586 Dptr = &D[0];
okini3939 0:8ba6230eefbd 587
okini3939 0:8ba6230eefbd 588 ptr = *Dptr + po;
okini3939 0:8ba6230eefbd 589 ML0(hi, lo, (*fx)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 590 MLA(hi, lo, (*fx)[1], ptr[14]);
okini3939 0:8ba6230eefbd 591 MLA(hi, lo, (*fx)[2], ptr[12]);
okini3939 0:8ba6230eefbd 592 MLA(hi, lo, (*fx)[3], ptr[10]);
okini3939 0:8ba6230eefbd 593 MLA(hi, lo, (*fx)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 594 MLA(hi, lo, (*fx)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 595 MLA(hi, lo, (*fx)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 596 MLA(hi, lo, (*fx)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 597 MLN(hi, lo);
okini3939 0:8ba6230eefbd 598
okini3939 0:8ba6230eefbd 599 ptr = *Dptr + pe;
okini3939 0:8ba6230eefbd 600 MLA(hi, lo, (*fe)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 601 MLA(hi, lo, (*fe)[1], ptr[14]);
okini3939 0:8ba6230eefbd 602 MLA(hi, lo, (*fe)[2], ptr[12]);
okini3939 0:8ba6230eefbd 603 MLA(hi, lo, (*fe)[3], ptr[10]);
okini3939 0:8ba6230eefbd 604 MLA(hi, lo, (*fe)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 605 MLA(hi, lo, (*fe)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 606 MLA(hi, lo, (*fe)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 607 MLA(hi, lo, (*fe)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 608
okini3939 0:8ba6230eefbd 609 *pcm1++ = SHIFT(MLZ(hi, lo));
okini3939 0:8ba6230eefbd 610
okini3939 0:8ba6230eefbd 611 pcm2 = pcm1 + 30;
okini3939 0:8ba6230eefbd 612
okini3939 0:8ba6230eefbd 613 for (sb = 1; sb < 16; ++sb) {
okini3939 0:8ba6230eefbd 614 ++fe;
okini3939 0:8ba6230eefbd 615 ++Dptr;
okini3939 0:8ba6230eefbd 616
okini3939 0:8ba6230eefbd 617 /* D[32 - sb][i] == -D[sb][31 - i] */
okini3939 0:8ba6230eefbd 618
okini3939 0:8ba6230eefbd 619 ptr = *Dptr + po;
okini3939 0:8ba6230eefbd 620 ML0(hi, lo, (*fo)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 621 MLA(hi, lo, (*fo)[1], ptr[14]);
okini3939 0:8ba6230eefbd 622 MLA(hi, lo, (*fo)[2], ptr[12]);
okini3939 0:8ba6230eefbd 623 MLA(hi, lo, (*fo)[3], ptr[10]);
okini3939 0:8ba6230eefbd 624 MLA(hi, lo, (*fo)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 625 MLA(hi, lo, (*fo)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 626 MLA(hi, lo, (*fo)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 627 MLA(hi, lo, (*fo)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 628 MLN(hi, lo);
okini3939 0:8ba6230eefbd 629
okini3939 0:8ba6230eefbd 630 ptr = *Dptr + pe;
okini3939 0:8ba6230eefbd 631 MLA(hi, lo, (*fe)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 632 MLA(hi, lo, (*fe)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 633 MLA(hi, lo, (*fe)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 634 MLA(hi, lo, (*fe)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 635 MLA(hi, lo, (*fe)[3], ptr[10]);
okini3939 0:8ba6230eefbd 636 MLA(hi, lo, (*fe)[2], ptr[12]);
okini3939 0:8ba6230eefbd 637 MLA(hi, lo, (*fe)[1], ptr[14]);
okini3939 0:8ba6230eefbd 638 MLA(hi, lo, (*fe)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 639
okini3939 0:8ba6230eefbd 640 *pcm1++ = SHIFT(MLZ(hi, lo));
okini3939 0:8ba6230eefbd 641
okini3939 0:8ba6230eefbd 642 ptr = *Dptr - pe;
okini3939 0:8ba6230eefbd 643 ML0(hi, lo, (*fe)[0], ptr[31 - 16]);
okini3939 0:8ba6230eefbd 644 MLA(hi, lo, (*fe)[1], ptr[31 - 14]);
okini3939 0:8ba6230eefbd 645 MLA(hi, lo, (*fe)[2], ptr[31 - 12]);
okini3939 0:8ba6230eefbd 646 MLA(hi, lo, (*fe)[3], ptr[31 - 10]);
okini3939 0:8ba6230eefbd 647 MLA(hi, lo, (*fe)[4], ptr[31 - 8]);
okini3939 0:8ba6230eefbd 648 MLA(hi, lo, (*fe)[5], ptr[31 - 6]);
okini3939 0:8ba6230eefbd 649 MLA(hi, lo, (*fe)[6], ptr[31 - 4]);
okini3939 0:8ba6230eefbd 650 MLA(hi, lo, (*fe)[7], ptr[31 - 2]);
okini3939 0:8ba6230eefbd 651
okini3939 0:8ba6230eefbd 652 ptr = *Dptr - po;
okini3939 0:8ba6230eefbd 653 MLA(hi, lo, (*fo)[7], ptr[31 - 2]);
okini3939 0:8ba6230eefbd 654 MLA(hi, lo, (*fo)[6], ptr[31 - 4]);
okini3939 0:8ba6230eefbd 655 MLA(hi, lo, (*fo)[5], ptr[31 - 6]);
okini3939 0:8ba6230eefbd 656 MLA(hi, lo, (*fo)[4], ptr[31 - 8]);
okini3939 0:8ba6230eefbd 657 MLA(hi, lo, (*fo)[3], ptr[31 - 10]);
okini3939 0:8ba6230eefbd 658 MLA(hi, lo, (*fo)[2], ptr[31 - 12]);
okini3939 0:8ba6230eefbd 659 MLA(hi, lo, (*fo)[1], ptr[31 - 14]);
okini3939 0:8ba6230eefbd 660 MLA(hi, lo, (*fo)[0], ptr[31 - 16]);
okini3939 0:8ba6230eefbd 661
okini3939 0:8ba6230eefbd 662 *pcm2-- = SHIFT(MLZ(hi, lo));
okini3939 0:8ba6230eefbd 663
okini3939 0:8ba6230eefbd 664 ++fo;
okini3939 0:8ba6230eefbd 665 }
okini3939 0:8ba6230eefbd 666
okini3939 0:8ba6230eefbd 667 ++Dptr;
okini3939 0:8ba6230eefbd 668
okini3939 0:8ba6230eefbd 669 ptr = *Dptr + po;
okini3939 0:8ba6230eefbd 670 ML0(hi, lo, (*fo)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 671 MLA(hi, lo, (*fo)[1], ptr[14]);
okini3939 0:8ba6230eefbd 672 MLA(hi, lo, (*fo)[2], ptr[12]);
okini3939 0:8ba6230eefbd 673 MLA(hi, lo, (*fo)[3], ptr[10]);
okini3939 0:8ba6230eefbd 674 MLA(hi, lo, (*fo)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 675 MLA(hi, lo, (*fo)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 676 MLA(hi, lo, (*fo)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 677 MLA(hi, lo, (*fo)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 678
okini3939 0:8ba6230eefbd 679 *pcm1 = SHIFT(-MLZ(hi, lo));
okini3939 0:8ba6230eefbd 680 pcm1 += 16;
okini3939 0:8ba6230eefbd 681
okini3939 0:8ba6230eefbd 682 phase = (phase + 1) % 16;
okini3939 0:8ba6230eefbd 683 }
okini3939 0:8ba6230eefbd 684 }
okini3939 0:8ba6230eefbd 685 }
okini3939 0:8ba6230eefbd 686 # endif
okini3939 0:8ba6230eefbd 687
okini3939 0:8ba6230eefbd 688 /*
okini3939 0:8ba6230eefbd 689 * NAME: synth->half()
okini3939 0:8ba6230eefbd 690 * DESCRIPTION: perform half frequency PCM synthesis
okini3939 0:8ba6230eefbd 691 */
okini3939 0:8ba6230eefbd 692 static
okini3939 0:8ba6230eefbd 693 void synth_half(struct mad_synth *synth, struct mad_frame const *frame,
okini3939 0:8ba6230eefbd 694 unsigned int nch, unsigned int ns)
okini3939 0:8ba6230eefbd 695 {
okini3939 0:8ba6230eefbd 696 unsigned int phase, ch, s, sb, pe, po;
okini3939 0:8ba6230eefbd 697 mad_fixed_t *pcm1, *pcm2, (*filter)[2][2][16][8];
okini3939 0:8ba6230eefbd 698 mad_fixed_t const (*sbsample)[36][32];
okini3939 0:8ba6230eefbd 699 register mad_fixed_t (*fe)[8], (*fx)[8], (*fo)[8];
okini3939 0:8ba6230eefbd 700 register mad_fixed_t const (*Dptr)[32], *ptr;
okini3939 0:8ba6230eefbd 701 register mad_fixed64hi_t hi;
okini3939 0:8ba6230eefbd 702 register mad_fixed64lo_t lo;
okini3939 0:8ba6230eefbd 703
okini3939 0:8ba6230eefbd 704 for (ch = 0; ch < nch; ++ch) {
okini3939 0:8ba6230eefbd 705 sbsample = &frame->sbsample[ch];
okini3939 0:8ba6230eefbd 706 filter = &synth->filter[ch];
okini3939 0:8ba6230eefbd 707 phase = synth->phase;
okini3939 0:8ba6230eefbd 708 pcm1 = synth->pcm.samples[ch];
okini3939 0:8ba6230eefbd 709
okini3939 0:8ba6230eefbd 710 for (s = 0; s < ns; ++s) {
okini3939 0:8ba6230eefbd 711 dct32((*sbsample)[s], phase >> 1,
okini3939 0:8ba6230eefbd 712 (*filter)[0][phase & 1], (*filter)[1][phase & 1]);
okini3939 0:8ba6230eefbd 713
okini3939 0:8ba6230eefbd 714 pe = phase & ~1;
okini3939 0:8ba6230eefbd 715 po = ((phase - 1) & 0xf) | 1;
okini3939 0:8ba6230eefbd 716
okini3939 0:8ba6230eefbd 717 /* calculate 16 samples */
okini3939 0:8ba6230eefbd 718
okini3939 0:8ba6230eefbd 719 fe = &(*filter)[0][ phase & 1][0];
okini3939 0:8ba6230eefbd 720 fx = &(*filter)[0][~phase & 1][0];
okini3939 0:8ba6230eefbd 721 fo = &(*filter)[1][~phase & 1][0];
okini3939 0:8ba6230eefbd 722
okini3939 0:8ba6230eefbd 723 Dptr = &D[0];
okini3939 0:8ba6230eefbd 724
okini3939 0:8ba6230eefbd 725 ptr = *Dptr + po;
okini3939 0:8ba6230eefbd 726 ML0(hi, lo, (*fx)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 727 MLA(hi, lo, (*fx)[1], ptr[14]);
okini3939 0:8ba6230eefbd 728 MLA(hi, lo, (*fx)[2], ptr[12]);
okini3939 0:8ba6230eefbd 729 MLA(hi, lo, (*fx)[3], ptr[10]);
okini3939 0:8ba6230eefbd 730 MLA(hi, lo, (*fx)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 731 MLA(hi, lo, (*fx)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 732 MLA(hi, lo, (*fx)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 733 MLA(hi, lo, (*fx)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 734 MLN(hi, lo);
okini3939 0:8ba6230eefbd 735
okini3939 0:8ba6230eefbd 736 ptr = *Dptr + pe;
okini3939 0:8ba6230eefbd 737 MLA(hi, lo, (*fe)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 738 MLA(hi, lo, (*fe)[1], ptr[14]);
okini3939 0:8ba6230eefbd 739 MLA(hi, lo, (*fe)[2], ptr[12]);
okini3939 0:8ba6230eefbd 740 MLA(hi, lo, (*fe)[3], ptr[10]);
okini3939 0:8ba6230eefbd 741 MLA(hi, lo, (*fe)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 742 MLA(hi, lo, (*fe)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 743 MLA(hi, lo, (*fe)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 744 MLA(hi, lo, (*fe)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 745
okini3939 0:8ba6230eefbd 746 *pcm1++ = SHIFT(MLZ(hi, lo));
okini3939 0:8ba6230eefbd 747
okini3939 0:8ba6230eefbd 748 pcm2 = pcm1 + 14;
okini3939 0:8ba6230eefbd 749
okini3939 0:8ba6230eefbd 750 for (sb = 1; sb < 16; ++sb) {
okini3939 0:8ba6230eefbd 751 ++fe;
okini3939 0:8ba6230eefbd 752 ++Dptr;
okini3939 0:8ba6230eefbd 753
okini3939 0:8ba6230eefbd 754 /* D[32 - sb][i] == -D[sb][31 - i] */
okini3939 0:8ba6230eefbd 755
okini3939 0:8ba6230eefbd 756 if (!(sb & 1)) {
okini3939 0:8ba6230eefbd 757 ptr = *Dptr + po;
okini3939 0:8ba6230eefbd 758 ML0(hi, lo, (*fo)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 759 MLA(hi, lo, (*fo)[1], ptr[14]);
okini3939 0:8ba6230eefbd 760 MLA(hi, lo, (*fo)[2], ptr[12]);
okini3939 0:8ba6230eefbd 761 MLA(hi, lo, (*fo)[3], ptr[10]);
okini3939 0:8ba6230eefbd 762 MLA(hi, lo, (*fo)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 763 MLA(hi, lo, (*fo)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 764 MLA(hi, lo, (*fo)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 765 MLA(hi, lo, (*fo)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 766 MLN(hi, lo);
okini3939 0:8ba6230eefbd 767
okini3939 0:8ba6230eefbd 768 ptr = *Dptr + pe;
okini3939 0:8ba6230eefbd 769 MLA(hi, lo, (*fe)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 770 MLA(hi, lo, (*fe)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 771 MLA(hi, lo, (*fe)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 772 MLA(hi, lo, (*fe)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 773 MLA(hi, lo, (*fe)[3], ptr[10]);
okini3939 0:8ba6230eefbd 774 MLA(hi, lo, (*fe)[2], ptr[12]);
okini3939 0:8ba6230eefbd 775 MLA(hi, lo, (*fe)[1], ptr[14]);
okini3939 0:8ba6230eefbd 776 MLA(hi, lo, (*fe)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 777
okini3939 0:8ba6230eefbd 778 *pcm1++ = SHIFT(MLZ(hi, lo));
okini3939 0:8ba6230eefbd 779
okini3939 0:8ba6230eefbd 780 ptr = *Dptr - po;
okini3939 0:8ba6230eefbd 781 ML0(hi, lo, (*fo)[7], ptr[31 - 2]);
okini3939 0:8ba6230eefbd 782 MLA(hi, lo, (*fo)[6], ptr[31 - 4]);
okini3939 0:8ba6230eefbd 783 MLA(hi, lo, (*fo)[5], ptr[31 - 6]);
okini3939 0:8ba6230eefbd 784 MLA(hi, lo, (*fo)[4], ptr[31 - 8]);
okini3939 0:8ba6230eefbd 785 MLA(hi, lo, (*fo)[3], ptr[31 - 10]);
okini3939 0:8ba6230eefbd 786 MLA(hi, lo, (*fo)[2], ptr[31 - 12]);
okini3939 0:8ba6230eefbd 787 MLA(hi, lo, (*fo)[1], ptr[31 - 14]);
okini3939 0:8ba6230eefbd 788 MLA(hi, lo, (*fo)[0], ptr[31 - 16]);
okini3939 0:8ba6230eefbd 789
okini3939 0:8ba6230eefbd 790 ptr = *Dptr - pe;
okini3939 0:8ba6230eefbd 791 MLA(hi, lo, (*fe)[0], ptr[31 - 16]);
okini3939 0:8ba6230eefbd 792 MLA(hi, lo, (*fe)[1], ptr[31 - 14]);
okini3939 0:8ba6230eefbd 793 MLA(hi, lo, (*fe)[2], ptr[31 - 12]);
okini3939 0:8ba6230eefbd 794 MLA(hi, lo, (*fe)[3], ptr[31 - 10]);
okini3939 0:8ba6230eefbd 795 MLA(hi, lo, (*fe)[4], ptr[31 - 8]);
okini3939 0:8ba6230eefbd 796 MLA(hi, lo, (*fe)[5], ptr[31 - 6]);
okini3939 0:8ba6230eefbd 797 MLA(hi, lo, (*fe)[6], ptr[31 - 4]);
okini3939 0:8ba6230eefbd 798 MLA(hi, lo, (*fe)[7], ptr[31 - 2]);
okini3939 0:8ba6230eefbd 799
okini3939 0:8ba6230eefbd 800 *pcm2-- = SHIFT(MLZ(hi, lo));
okini3939 0:8ba6230eefbd 801 }
okini3939 0:8ba6230eefbd 802
okini3939 0:8ba6230eefbd 803 ++fo;
okini3939 0:8ba6230eefbd 804 }
okini3939 0:8ba6230eefbd 805
okini3939 0:8ba6230eefbd 806 ++Dptr;
okini3939 0:8ba6230eefbd 807
okini3939 0:8ba6230eefbd 808 ptr = *Dptr + po;
okini3939 0:8ba6230eefbd 809 ML0(hi, lo, (*fo)[0], ptr[ 0]);
okini3939 0:8ba6230eefbd 810 MLA(hi, lo, (*fo)[1], ptr[14]);
okini3939 0:8ba6230eefbd 811 MLA(hi, lo, (*fo)[2], ptr[12]);
okini3939 0:8ba6230eefbd 812 MLA(hi, lo, (*fo)[3], ptr[10]);
okini3939 0:8ba6230eefbd 813 MLA(hi, lo, (*fo)[4], ptr[ 8]);
okini3939 0:8ba6230eefbd 814 MLA(hi, lo, (*fo)[5], ptr[ 6]);
okini3939 0:8ba6230eefbd 815 MLA(hi, lo, (*fo)[6], ptr[ 4]);
okini3939 0:8ba6230eefbd 816 MLA(hi, lo, (*fo)[7], ptr[ 2]);
okini3939 0:8ba6230eefbd 817
okini3939 0:8ba6230eefbd 818 *pcm1 = SHIFT(-MLZ(hi, lo));
okini3939 0:8ba6230eefbd 819 pcm1 += 8;
okini3939 0:8ba6230eefbd 820
okini3939 0:8ba6230eefbd 821 phase = (phase + 1) % 16;
okini3939 0:8ba6230eefbd 822 }
okini3939 0:8ba6230eefbd 823 }
okini3939 0:8ba6230eefbd 824 }
okini3939 0:8ba6230eefbd 825
okini3939 0:8ba6230eefbd 826 /*
okini3939 0:8ba6230eefbd 827 * NAME: synth->frame()
okini3939 0:8ba6230eefbd 828 * DESCRIPTION: perform PCM synthesis of frame subband samples
okini3939 0:8ba6230eefbd 829 */
okini3939 0:8ba6230eefbd 830 void mad_synth_frame(struct mad_synth *synth, struct mad_frame const *frame)
okini3939 0:8ba6230eefbd 831 {
okini3939 0:8ba6230eefbd 832 unsigned int nch, ns;
okini3939 0:8ba6230eefbd 833 void (*synth_frame)(struct mad_synth *, struct mad_frame const *,
okini3939 0:8ba6230eefbd 834 unsigned int, unsigned int);
okini3939 0:8ba6230eefbd 835
okini3939 0:8ba6230eefbd 836 nch = MAD_NCHANNELS(&frame->header);
okini3939 0:8ba6230eefbd 837 ns = MAD_NSBSAMPLES(&frame->header);
okini3939 0:8ba6230eefbd 838
okini3939 0:8ba6230eefbd 839 synth->pcm.samplerate = frame->header.samplerate;
okini3939 0:8ba6230eefbd 840 synth->pcm.channels = nch;
okini3939 0:8ba6230eefbd 841 synth->pcm.length = 32 * ns;
okini3939 0:8ba6230eefbd 842
okini3939 0:8ba6230eefbd 843 synth_frame = synth_full;
okini3939 0:8ba6230eefbd 844
okini3939 0:8ba6230eefbd 845 if (frame->options & MAD_OPTION_HALFSAMPLERATE) {
okini3939 0:8ba6230eefbd 846 synth->pcm.samplerate /= 2;
okini3939 0:8ba6230eefbd 847 synth->pcm.length /= 2;
okini3939 0:8ba6230eefbd 848
okini3939 0:8ba6230eefbd 849 synth_frame = synth_half;
okini3939 0:8ba6230eefbd 850 }
okini3939 0:8ba6230eefbd 851
okini3939 0:8ba6230eefbd 852 synth_frame(synth, frame, nch, ns);
okini3939 0:8ba6230eefbd 853
okini3939 0:8ba6230eefbd 854 synth->phase = (synth->phase + ns) % 16;
okini3939 0:8ba6230eefbd 855 }