Files
2026-08-24 10:03:24 +08:00

584 lines
20 KiB
C

/*
** FAAD2 - Freeware Advanced Audio (AAC) Decoder including SBR decoding
** Copyright (C) 2003-2005 M. Bakker, Nero AG, http://www.nero.com
**
** This program is free software; you can redistribute it and/or modify
** it under the terms of the GNU General Public License as published by
** the Free Software Foundation; either version 2 of the License, or
** (at your option) any later version.
**
** This program is distributed in the hope that it will be useful,
** but WITHOUT ANY WARRANTY; without even the implied warranty of
** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
** GNU General Public License for more details.
**
** You should have received a copy of the GNU General Public License
** along with this program; if not, write to the Free Software
** Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
**
** Any non-GPL usage of this software or parts of this software is strictly
** forbidden.
**
** The "appropriate copyright message" mentioned in section 2c of the GPLv2
** must read: "Code from FAAD2 is copyright (c) Nero AG, www.nero.com"
**
** Commercial non-GPL licensing of this software is possible.
** For more info contact Nero AG through [email protected].
**
** $Id: output.c,v 1.47 2009/01/26 23:51:15 menno Exp $
**/
#include "common.h"
#include "structs.h"
#include "output.h"
#ifndef FIXED_POINT
#define FLOAT_SCALE (1.0f/(1<<15))
#define DM_MUL 1//REAL_CONST(0.3203772410170407) // 1/(1+sqrt(2) + 1/sqrt(2))
#define RSQRT2 REAL_CONST(0.7071067811865475244) // 1/sqrt(2)
/*
There are two types of down-mix to stereo:
1. Lt/Rt downmix:
Lt = L + (0.707*C) - (0.707*Ls) - (0.707*Rs)
Rt = R + (0.707*C) + (0.707*Ls) + (0.707*Rs)
2. Lo/Ro downmix:
Lo = L + (0.707*C) + (0.707*Ls)
Ro = R + (0.707*C) + (0.707*Rs)
*/
static INLINE real_t get_sample(real_t **input, uint8_t channel, uint16_t sample,
uint8_t down_matrix, uint8_t *internal_channel)
{
if (!down_matrix) {
return input[internal_channel[channel]][sample];
}
// for multi-channel( > 2ch ) downmix to 2ch case
#if 0 //LoRo downmix mode
if (channel == 0) {
return DM_MUL * (input[internal_channel[1]][sample] +
input[internal_channel[0]][sample] * RSQRT2 +
input[internal_channel[3]][sample] * RSQRT2);
} else {
return DM_MUL * (input[internal_channel[2]][sample] +
input[internal_channel[0]][sample] * RSQRT2 +
input[internal_channel[4]][sample] * RSQRT2);
}
#else //LtRt downmix mode
if (channel == 0) {
return DM_MUL * (input[internal_channel[1]][sample] +
input[internal_channel[0]][sample] * RSQRT2 -
input[internal_channel[3]][sample] * RSQRT2 - input[internal_channel[4]][sample] * RSQRT2);
} else {
return DM_MUL * (input[internal_channel[2]][sample] +
input[internal_channel[0]][sample] * RSQRT2 +
input[internal_channel[3]][sample] * RSQRT2 +
input[internal_channel[4]][sample] * RSQRT2);
}
#endif
}
#ifndef HAS_LRINTF
#define CLIP(sample, max, min) \
if (sample >= 0.0f) \
{ \
sample += 0.5f; \
if (sample >= max) \
sample = max; \
} else { \
sample += -0.5f; \
if (sample <= min) \
sample = min; \
}
#else
#define CLIP(sample, max, min) \
if (sample >= 0.0f) \
{ \
if (sample >= max) \
sample = max; \
} else { \
if (sample <= min) \
sample = min; \
}
#endif
#define CONV(a,b) ((a<<1)|(b&0x1))
static void to_PCM_16bit(NeAACDecStruct *hDecoder, real_t **input,
uint8_t channels, uint16_t frame_len,
int16_t **sample_buffer)
{
uint8_t ch, ch1;
uint16_t i;
uint16_t k;
switch (CONV(channels, hDecoder->downMatrix)) {
case CONV(1, 0):
case CONV(1, 1):
for (i = 0; i < frame_len; i++) {
real_t inp = input[hDecoder->internal_channel[0]][i];
CLIP(inp, 32767.0f, -32768.0f);
(*sample_buffer)[i] = (int16_t)lrintf(inp);
}
break;
case CONV(2, 0):
if (hDecoder->upMatrix) {
ch = hDecoder->internal_channel[0];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch][i];
CLIP(inp0, 32767.0f, -32768.0f);
(*sample_buffer)[(i * 2) + 0] = (int16_t)lrintf(inp0);
(*sample_buffer)[(i * 2) + 1] = (int16_t)lrintf(inp0);
}
} else {
ch = hDecoder->internal_channel[0];
ch1 = hDecoder->internal_channel[1];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch ][i];
real_t inp1 = input[ch1][i];
CLIP(inp0, 32767.0f, -32768.0f);
CLIP(inp1, 32767.0f, -32768.0f);
(*sample_buffer)[(i * 2) + 0] = (int16_t)lrintf(inp0);
(*sample_buffer)[(i * 2) + 1] = (int16_t)lrintf(inp1);
}
}
break;
default:
#if 0
for (ch = 0; ch < channels; ch++) {
for (i = 0; i < frame_len; i++) {
real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
CLIP(inp, 32767.0f, -32768.0f);
(*sample_buffer)[(i * channels) + ch] = (int16_t)lrintf(inp);
}
}
#endif
if (channels == 6) {
for (ch = 0; ch < channels; ch += 6) {
for (i = 0; i < frame_len; i++) {
real_t inp[6];
real_t Lt, Rt;
for (k = 0; k < 6; k++) {
inp[k] = get_sample(input, ch + k, i, hDecoder->downMatrix, hDecoder->internal_channel);
CLIP(inp[k], 32767.0f, -32768.0f);
}
Lt = 1.0 * inp[1] + 0.707 * inp[0] - 0.707 * inp[3] - 0.707 * inp[4];
Rt = 1.0 * inp[2] + 0.707 * inp[0] + 0.707 * inp[3] - 0.707 * inp[4];
(*sample_buffer)[(i * channels) + ch] = (int16_t)lrintf(Lt);
(*sample_buffer)[(i * channels) + ch + 1] = (int16_t)lrintf(Rt);
}
}
} else if (4 == channels) {
for (ch = 0; ch < channels; ch++) {
if (ch % 2 != 0) {
continue;
}
for (i = 0; i < frame_len; i++) {
real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
CLIP(inp, 32767.0f, -32768.0f);
if (ch > 0) {
ch = 1;
}
(*sample_buffer)[(i * channels) + ch] = (int16_t)lrintf(inp);
}
}
} else {
for (ch = 0; ch < channels; ch++) {
for (i = 0; i < frame_len; i++) {
real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
CLIP(inp, 32767.0f, -32768.0f);
(*sample_buffer)[(i * channels) + ch] = (int16_t)lrintf(inp);
}
}
}
break;
}
}
static void to_PCM_24bit(NeAACDecStruct *hDecoder, real_t **input,
uint8_t channels, uint16_t frame_len,
int32_t **sample_buffer)
{
uint8_t ch, ch1;
uint16_t i;
switch (CONV(channels, hDecoder->downMatrix)) {
case CONV(1, 0):
case CONV(1, 1):
for (i = 0; i < frame_len; i++) {
real_t inp = input[hDecoder->internal_channel[0]][i];
inp *= 256.0f;
CLIP(inp, 8388607.0f, -8388608.0f);
(*sample_buffer)[i] = (int32_t)lrintf(inp);
}
break;
case CONV(2, 0):
if (hDecoder->upMatrix) {
ch = hDecoder->internal_channel[0];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch][i];
inp0 *= 256.0f;
CLIP(inp0, 8388607.0f, -8388608.0f);
(*sample_buffer)[(i * 2) + 0] = (int32_t)lrintf(inp0);
(*sample_buffer)[(i * 2) + 1] = (int32_t)lrintf(inp0);
}
} else {
ch = hDecoder->internal_channel[0];
ch1 = hDecoder->internal_channel[1];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch ][i];
real_t inp1 = input[ch1][i];
inp0 *= 256.0f;
inp1 *= 256.0f;
CLIP(inp0, 8388607.0f, -8388608.0f);
CLIP(inp1, 8388607.0f, -8388608.0f);
(*sample_buffer)[(i * 2) + 0] = (int32_t)lrintf(inp0);
(*sample_buffer)[(i * 2) + 1] = (int32_t)lrintf(inp1);
}
}
break;
default:
for (ch = 0; ch < channels; ch++) {
for (i = 0; i < frame_len; i++) {
real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
inp *= 256.0f;
CLIP(inp, 8388607.0f, -8388608.0f);
(*sample_buffer)[(i * channels) + ch] = (int32_t)lrintf(inp);
}
}
break;
}
}
static void to_PCM_32bit(NeAACDecStruct *hDecoder, real_t **input,
uint8_t channels, uint16_t frame_len,
int32_t **sample_buffer)
{
uint8_t ch, ch1;
uint16_t i;
switch (CONV(channels, hDecoder->downMatrix)) {
case CONV(1, 0):
case CONV(1, 1):
for (i = 0; i < frame_len; i++) {
real_t inp = input[hDecoder->internal_channel[0]][i];
inp *= 65536.0f;
CLIP(inp, 2147483647.0f, -2147483648.0f);
(*sample_buffer)[i] = (int32_t)lrintf(inp);
}
break;
case CONV(2, 0):
if (hDecoder->upMatrix) {
ch = hDecoder->internal_channel[0];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch][i];
inp0 *= 65536.0f;
CLIP(inp0, 2147483647.0f, -2147483648.0f);
(*sample_buffer)[(i * 2) + 0] = (int32_t)lrintf(inp0);
(*sample_buffer)[(i * 2) + 1] = (int32_t)lrintf(inp0);
}
} else {
ch = hDecoder->internal_channel[0];
ch1 = hDecoder->internal_channel[1];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch ][i];
real_t inp1 = input[ch1][i];
inp0 *= 65536.0f;
inp1 *= 65536.0f;
CLIP(inp0, 2147483647.0f, -2147483648.0f);
CLIP(inp1, 2147483647.0f, -2147483648.0f);
(*sample_buffer)[(i * 2) + 0] = (int32_t)lrintf(inp0);
(*sample_buffer)[(i * 2) + 1] = (int32_t)lrintf(inp1);
}
}
break;
default:
for (ch = 0; ch < channels; ch++) {
for (i = 0; i < frame_len; i++) {
real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
inp *= 65536.0f;
CLIP(inp, 2147483647.0f, -2147483648.0f);
(*sample_buffer)[(i * channels) + ch] = (int32_t)lrintf(inp);
}
}
break;
}
}
static void to_PCM_float(NeAACDecStruct *hDecoder, real_t **input,
uint8_t channels, uint16_t frame_len,
float32_t **sample_buffer)
{
uint8_t ch, ch1;
uint16_t i;
switch (CONV(channels, hDecoder->downMatrix)) {
case CONV(1, 0):
case CONV(1, 1):
for (i = 0; i < frame_len; i++) {
real_t inp = input[hDecoder->internal_channel[0]][i];
(*sample_buffer)[i] = inp * FLOAT_SCALE;
}
break;
case CONV(2, 0):
if (hDecoder->upMatrix) {
ch = hDecoder->internal_channel[0];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch][i];
(*sample_buffer)[(i * 2) + 0] = inp0 * FLOAT_SCALE;
(*sample_buffer)[(i * 2) + 1] = inp0 * FLOAT_SCALE;
}
} else {
ch = hDecoder->internal_channel[0];
ch1 = hDecoder->internal_channel[1];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch ][i];
real_t inp1 = input[ch1][i];
(*sample_buffer)[(i * 2) + 0] = inp0 * FLOAT_SCALE;
(*sample_buffer)[(i * 2) + 1] = inp1 * FLOAT_SCALE;
}
}
break;
default:
for (ch = 0; ch < channels; ch++) {
for (i = 0; i < frame_len; i++) {
real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
(*sample_buffer)[(i * channels) + ch] = inp * FLOAT_SCALE;
}
}
break;
}
}
static void to_PCM_double(NeAACDecStruct *hDecoder, real_t **input,
uint8_t channels, uint16_t frame_len,
double **sample_buffer)
{
uint8_t ch, ch1;
uint16_t i;
switch (CONV(channels, hDecoder->downMatrix)) {
case CONV(1, 0):
case CONV(1, 1):
for (i = 0; i < frame_len; i++) {
real_t inp = input[hDecoder->internal_channel[0]][i];
(*sample_buffer)[i] = (double)inp * FLOAT_SCALE;
}
break;
case CONV(2, 0):
if (hDecoder->upMatrix) {
ch = hDecoder->internal_channel[0];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch][i];
(*sample_buffer)[(i * 2) + 0] = (double)inp0 * FLOAT_SCALE;
(*sample_buffer)[(i * 2) + 1] = (double)inp0 * FLOAT_SCALE;
}
} else {
ch = hDecoder->internal_channel[0];
ch1 = hDecoder->internal_channel[1];
for (i = 0; i < frame_len; i++) {
real_t inp0 = input[ch ][i];
real_t inp1 = input[ch1][i];
(*sample_buffer)[(i * 2) + 0] = (double)inp0 * FLOAT_SCALE;
(*sample_buffer)[(i * 2) + 1] = (double)inp1 * FLOAT_SCALE;
}
}
break;
default:
for (ch = 0; ch < channels; ch++) {
for (i = 0; i < frame_len; i++) {
real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
(*sample_buffer)[(i * channels) + ch] = (double)inp * FLOAT_SCALE;
}
}
break;
}
}
void *output_to_PCM(NeAACDecStruct *hDecoder,
real_t **input, void *sample_buffer, uint8_t channels,
uint16_t frame_len, uint8_t format)
{
int16_t *short_sample_buffer = (int16_t*)sample_buffer;
int32_t *int_sample_buffer = (int32_t*)sample_buffer;
float32_t *float_sample_buffer = (float32_t*)sample_buffer;
double *double_sample_buffer = (double*)sample_buffer;
#ifdef PROFILE
int64_t count = faad_get_ts();
#endif
/* Copy output to a standard PCM buffer */
switch (format) {
case FAAD_FMT_16BIT:
to_PCM_16bit(hDecoder, input, channels, frame_len, &short_sample_buffer);
break;
case FAAD_FMT_24BIT:
to_PCM_24bit(hDecoder, input, channels, frame_len, &int_sample_buffer);
break;
case FAAD_FMT_32BIT:
to_PCM_32bit(hDecoder, input, channels, frame_len, &int_sample_buffer);
break;
case FAAD_FMT_FLOAT:
to_PCM_float(hDecoder, input, channels, frame_len, &float_sample_buffer);
break;
case FAAD_FMT_DOUBLE:
to_PCM_double(hDecoder, input, channels, frame_len, &double_sample_buffer);
break;
}
#ifdef PROFILE
count = faad_get_ts() - count;
hDecoder->output_cycles += count;
#endif
return sample_buffer;
}
#else
#define DM_MUL FRAC_CONST(0.3203772410170407) // 1/(1+sqrt(2) + 1/sqrt(2))
#define RSQRT2 FRAC_CONST(0.7071067811865475244) // 1/sqrt(2)
static INLINE real_t get_sample(real_t **input, uint8_t channel, uint16_t sample,
uint8_t down_matrix, uint8_t up_matrix,
uint8_t *internal_channel)
{
if (up_matrix == 1) {
return input[internal_channel[0]][sample];
}
if (!down_matrix) {
return input[internal_channel[channel]][sample];
}
if (channel == 0) {
real_t C = MUL_F(input[internal_channel[0]][sample], RSQRT2);
real_t L_S = MUL_F(input[internal_channel[3]][sample], RSQRT2);
real_t cum = input[internal_channel[1]][sample] + C + L_S;
return MUL_F(cum, DM_MUL);
} else {
real_t C = MUL_F(input[internal_channel[0]][sample], RSQRT2);
real_t R_S = MUL_F(input[internal_channel[4]][sample], RSQRT2);
real_t cum = input[internal_channel[2]][sample] + C + R_S;
return MUL_F(cum, DM_MUL);
}
}
void* output_to_PCM(NeAACDecStruct *hDecoder,
real_t **input, void *sample_buffer, uint8_t channels,
uint16_t frame_len, uint8_t format)
{
uint8_t ch;
uint16_t i;
int16_t *short_sample_buffer = (int16_t*)sample_buffer;
int32_t *int_sample_buffer = (int32_t*)sample_buffer;
/* Copy output to a standard PCM buffer */
for (ch = 0; ch < channels; ch++) {
switch (format) {
case FAAD_FMT_16BIT:
for (i = 0; i < frame_len; i++) {
int32_t tmp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->upMatrix,
hDecoder->internal_channel);
if (tmp >= 0) {
tmp += (1 << (REAL_BITS - 1));
if (tmp >= REAL_CONST(32767)) {
tmp = REAL_CONST(32767);
}
} else {
tmp += -(1 << (REAL_BITS - 1));
if (tmp <= REAL_CONST(-32768)) {
tmp = REAL_CONST(-32768);
}
}
tmp >>= REAL_BITS;
short_sample_buffer[(i * channels) + ch] = (int16_t)tmp;
}
break;
case FAAD_FMT_24BIT:
for (i = 0; i < frame_len; i++) {
int32_t tmp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->upMatrix,
hDecoder->internal_channel);
if (tmp >= 0) {
tmp += (1 << (REAL_BITS - 9));
tmp >>= (REAL_BITS - 8);
if (tmp >= 8388607) {
tmp = 8388607;
}
} else {
tmp += -(1 << (REAL_BITS - 9));
tmp >>= (REAL_BITS - 8);
if (tmp <= -8388608) {
tmp = -8388608;
}
}
int_sample_buffer[(i * channels) + ch] = (int32_t)tmp;
}
break;
case FAAD_FMT_32BIT:
for (i = 0; i < frame_len; i++) {
int32_t tmp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->upMatrix,
hDecoder->internal_channel);
if (tmp >= 0) {
tmp += (1 << (16 - REAL_BITS - 1));
tmp <<= (16 - REAL_BITS);
} else {
tmp += -(1 << (16 - REAL_BITS - 1));
tmp <<= (16 - REAL_BITS);
}
int_sample_buffer[(i * channels) + ch] = (int32_t)tmp;
}
break;
case FAAD_FMT_FIXED:
for (i = 0; i < frame_len; i++) {
real_t tmp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->upMatrix,
hDecoder->internal_channel);
int_sample_buffer[(i * channels) + ch] = (int32_t)tmp;
}
break;
}
}
return sample_buffer;
}
#endif