/proc/self/cwd/libfaad/output.c

Source
/*
** 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 Mpeg4AAClicense@nero.com.
**
** $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 REAL_CONST(0.3203772410170407) // 1/(1+sqrt(2) + 1/sqrt(2))
#define RSQRT2 REAL_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 *internal_channel)
{
    if (!down_matrix)
        return input[internal_channel[channel]][sample];

    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);
    }
}

#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;

    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:
        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)
#define BOTH FRAC_CONST(0.2265409196609864215998) // 1/(sqrt(2) + 2 + 1)

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)
{
    real_t C;
    if (up_matrix == 1)
        return input[internal_channel[0]][sample];

    if (!down_matrix)
        return input[internal_channel[channel]][sample];

    C = MUL_F(input[internal_channel[0]][sample], BOTH);
    if (channel == 0)
    {
        real_t L_S = MUL_F(input[internal_channel[3]][sample], BOTH);
        real_t core = MUL_F(input[internal_channel[1]][sample], DM_MUL);
        return core + C + L_S;
    } else {
        real_t R_S = MUL_F(input[internal_channel[4]][sample], BOTH);
        real_t core = MUL_F(input[internal_channel[2]][sample], DM_MUL);
        return core + C + R_S;
    }
}

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;
    int32_t exp, half, sat_shift_mask;

    /* 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)
                {
                    if (tmp <= 0x7FFFFFFF - (1 << (REAL_BITS-1)))
                        tmp += (1 << (REAL_BITS-1));
                    if (tmp >= REAL_CONST(32767))
                    {
                        tmp = REAL_CONST(32767);
                    }
                } else {
                    if (tmp >= (int32_t)0x80000000 + (1 << (REAL_BITS-1)))
                        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)
                {
                    if (tmp <= 0x7FFFFFFF - (1 << (REAL_BITS-9)))
                        tmp += (1 << (REAL_BITS-9));
                    tmp >>= (REAL_BITS-8);
                    if (tmp >= 8388607)
                    {
                        tmp = 8388607;
                    }
                } else {
                    if (tmp >= (int32_t)0x80000000 + (1 << (REAL_BITS-9)))
                        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:
            exp = 16 - REAL_BITS;
            half = 1 << (exp - 1);
            sat_shift_mask = SAT_SHIFT_MASK(exp);
            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)
                {
                    if (tmp <= 0x7FFFFFFF - half)
                        tmp += half;
                } else {
                    if (tmp >= (int32_t)0x80000000 + half)
                        tmp += -half;
                }
                tmp = SAT_SHIFT(tmp, exp, sat_shift_mask);
                int_sample_buffer[(i*channels)+ch] = 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

Coverage Report

Created: 2026-08-31 07:13

Line	Count	Source
1		/*
2		** FAAD2 - Freeware Advanced Audio (AAC) Decoder including SBR decoding
3		** Copyright (C) 2003-2005 M. Bakker, Nero AG, http://www.nero.com
4		**
5		** This program is free software; you can redistribute it and/or modify
6		** it under the terms of the GNU General Public License as published by
7		** the Free Software Foundation; either version 2 of the License, or
8		** (at your option) any later version.
9		**
10		** This program is distributed in the hope that it will be useful,
11		** but WITHOUT ANY WARRANTY; without even the implied warranty of
12		** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13		** GNU General Public License for more details.
14		**
15		** You should have received a copy of the GNU General Public License
16		** along with this program; if not, write to the Free Software
17		** Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
18		**
19		** Any non-GPL usage of this software or parts of this software is strictly
20		** forbidden.
21		**
22		** The "appropriate copyright message" mentioned in section 2c of the GPLv2
23		** must read: "Code from FAAD2 is copyright (c) Nero AG, www.nero.com"
24		**
25		** Commercial non-GPL licensing of this software is possible.
26		** For more info contact Nero AG through Mpeg4AAClicense@nero.com.
27		**
28		** $Id: output.c,v 1.47 2009/01/26 23:51:15 menno Exp $
29		**/
30
31		#include "common.h"
32		#include "structs.h"
33
34		#include "output.h"
35
36		#ifndef FIXED_POINT
37
38
39	6.76M	#define FLOAT_SCALE (1.0f/(1<<15))
40
41	1.38M	#define DM_MUL REAL_CONST(0.3203772410170407) // 1/(1+sqrt(2) + 1/sqrt(2))
42	2.77M	#define RSQRT2 REAL_CONST(0.7071067811865475244) // 1/sqrt(2)
43
44
45		static INLINE real_t get_sample(real_t **input, uint8_t channel, uint16_t sample,
46		uint8_t down_matrix, uint8_t *internal_channel)
47	22.1M	{
48	22.1M	if (!down_matrix)
49	20.7M	return input[internal_channel[channel]][sample];
50
51	1.38M	if (channel == 0)
52	682k	{
53	682k	return DM_MUL * (input[internal_channel[1]][sample] +
54	682k	input[internal_channel[0]][sample] * RSQRT2 +
55	682k	input[internal_channel[3]][sample] * RSQRT2);
56	706k	} else {
57	706k	return DM_MUL * (input[internal_channel[2]][sample] +
58	706k	input[internal_channel[0]][sample] * RSQRT2 +
59	706k	input[internal_channel[4]][sample] * RSQRT2);
60	706k	}
61	1.38M	}
62
63		#ifndef HAS_LRINTF
64	18.8M	#define CLIP(sample, max, min) \
65	18.8M	if (sample >= 0.0f) \
66	16.5M	{ \
67	16.5M	sample += 0.5f; \
68	16.5M	if (sample >= max) \
69	16.5M	sample = max; \
70	16.5M	} else { \
71	2.32M	sample += -0.5f; \
72	2.32M	if (sample <= min) \
73	2.32M	sample = min; \
74	2.32M	}
75		#else
76		#define CLIP(sample, max, min) \
77		if (sample >= 0.0f) \
78		{ \
79		if (sample >= max) \
80		sample = max; \
81		} else { \
82		if (sample <= min) \
83		sample = min; \
84		}
85		#endif
86
87	4.38k	#define CONV(a,b) ((a<<1)\|(b&0x1))
88
89		static void to_PCM_16bit(NeAACDecStruct hDecoder, real_t *input,
90		uint8_t channels, uint16_t frame_len,
91		int16_t **sample_buffer)
92	954	{
93	954	uint8_t ch, ch1;
94	954	uint16_t i;
95
96	954	switch (CONV(channels,hDecoder->downMatrix))
97	954	{
98	0	case CONV(1,0):
99	0	case CONV(1,1):
100	0	for(i = 0; i < frame_len; i++)
101	0	{
102	0	real_t inp = input[hDecoder->internal_channel[0]][i];
103
104	0	CLIP(inp, 32767.0f, -32768.0f);
105
106	0	(*sample_buffer)[i] = (int16_t)lrintf(inp);
107	0	}
108	0	break;
109	423	case CONV(2,0):
110	423	if (hDecoder->upMatrix)
111	56	{
112	56	ch = hDecoder->internal_channel[0];
113	87.5k	for(i = 0; i < frame_len; i++)
114	87.4k	{
115	87.4k	real_t inp0 = input[ch][i];
116
117	87.4k	CLIP(inp0, 32767.0f, -32768.0f);
118
119	87.4k	(sample_buffer)[(i2)+0] = (int16_t)lrintf(inp0);
120	87.4k	(sample_buffer)[(i2)+1] = (int16_t)lrintf(inp0);
121	87.4k	}
122	367	} else {
123	367	ch = hDecoder->internal_channel[0];
124	367	ch1 = hDecoder->internal_channel[1];
125	545k	for(i = 0; i < frame_len; i++)
126	545k	{
127	545k	real_t inp0 = input[ch ][i];
128	545k	real_t inp1 = input[ch1][i];
129
130	545k	CLIP(inp0, 32767.0f, -32768.0f);
131	545k	CLIP(inp1, 32767.0f, -32768.0f);
132
133	545k	(sample_buffer)[(i2)+0] = (int16_t)lrintf(inp0);
134	545k	(sample_buffer)[(i2)+1] = (int16_t)lrintf(inp1);
135	545k	}
136	367	}
137	423	break;
138	531	default:
139	4.90k	for (ch = 0; ch < channels; ch++)
140	4.37k	{
141	6.36M	for(i = 0; i < frame_len; i++)
142	6.35M	{
143	6.35M	real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
144
145	6.35M	CLIP(inp, 32767.0f, -32768.0f);
146
147	6.35M	(sample_buffer)[(ichannels)+ch] = (int16_t)lrintf(inp);
148	6.35M	}
149	4.37k	}
150	531	break;
151	954	}
152	954	}
153
154		static void to_PCM_24bit(NeAACDecStruct hDecoder, real_t *input,
155		uint8_t channels, uint16_t frame_len,
156		int32_t **sample_buffer)
157	805	{
158	805	uint8_t ch, ch1;
159	805	uint16_t i;
160
161	805	switch (CONV(channels,hDecoder->downMatrix))
162	805	{
163	0	case CONV(1,0):
164	0	case CONV(1,1):
165	0	for(i = 0; i < frame_len; i++)
166	0	{
167	0	real_t inp = input[hDecoder->internal_channel[0]][i];
168
169	0	inp *= 256.0f;
170	0	CLIP(inp, 8388607.0f, -8388608.0f);
171
172	0	(*sample_buffer)[i] = (int32_t)lrintf(inp);
173	0	}
174	0	break;
175	389	case CONV(2,0):
176	389	if (hDecoder->upMatrix)
177	35	{
178	35	ch = hDecoder->internal_channel[0];
179	58.2k	for(i = 0; i < frame_len; i++)
180	58.2k	{
181	58.2k	real_t inp0 = input[ch][i];
182
183	58.2k	inp0 *= 256.0f;
184	58.2k	CLIP(inp0, 8388607.0f, -8388608.0f);
185
186	58.2k	(sample_buffer)[(i2)+0] = (int32_t)lrintf(inp0);
187	58.2k	(sample_buffer)[(i2)+1] = (int32_t)lrintf(inp0);
188	58.2k	}
189	354	} else {
190	354	ch = hDecoder->internal_channel[0];
191	354	ch1 = hDecoder->internal_channel[1];
192	488k	for(i = 0; i < frame_len; i++)
193	488k	{
194	488k	real_t inp0 = input[ch ][i];
195	488k	real_t inp1 = input[ch1][i];
196
197	488k	inp0 *= 256.0f;
198	488k	inp1 *= 256.0f;
199	488k	CLIP(inp0, 8388607.0f, -8388608.0f);
200	488k	CLIP(inp1, 8388607.0f, -8388608.0f);
201
202	488k	(sample_buffer)[(i2)+0] = (int32_t)lrintf(inp0);
203	488k	(sample_buffer)[(i2)+1] = (int32_t)lrintf(inp1);
204	488k	}
205	354	}
206	389	break;
207	416	default:
208	3.61k	for (ch = 0; ch < channels; ch++)
209	3.19k	{
210	4.73M	for(i = 0; i < frame_len; i++)
211	4.73M	{
212	4.73M	real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
213
214	4.73M	inp *= 256.0f;
215	4.73M	CLIP(inp, 8388607.0f, -8388608.0f);
216
217	4.73M	(sample_buffer)[(ichannels)+ch] = (int32_t)lrintf(inp);
218	4.73M	}
219	3.19k	}
220	416	break;
221	805	}
222	805	}
223
224		static void to_PCM_32bit(NeAACDecStruct hDecoder, real_t *input,
225		uint8_t channels, uint16_t frame_len,
226		int32_t **sample_buffer)
227	763	{
228	763	uint8_t ch, ch1;
229	763	uint16_t i;
230
231	763	switch (CONV(channels,hDecoder->downMatrix))
232	763	{
233	0	case CONV(1,0):
234	0	case CONV(1,1):
235	0	for(i = 0; i < frame_len; i++)
236	0	{
237	0	real_t inp = input[hDecoder->internal_channel[0]][i];
238
239	0	inp *= 65536.0f;
240	0	CLIP(inp, 2147483647.0f, -2147483648.0f);
241
242	0	(*sample_buffer)[i] = (int32_t)lrintf(inp);
243	0	}
244	0	break;
245	356	case CONV(2,0):
246	356	if (hDecoder->upMatrix)
247	38	{
248	38	ch = hDecoder->internal_channel[0];
249	60.1k	for(i = 0; i < frame_len; i++)
250	60.1k	{
251	60.1k	real_t inp0 = input[ch][i];
252
253	60.1k	inp0 *= 65536.0f;
254	60.1k	CLIP(inp0, 2147483647.0f, -2147483648.0f);
255
256	60.1k	(sample_buffer)[(i2)+0] = (int32_t)lrintf(inp0);
257	60.1k	(sample_buffer)[(i2)+1] = (int32_t)lrintf(inp0);
258	60.1k	}
259	318	} else {
260	318	ch = hDecoder->internal_channel[0];
261	318	ch1 = hDecoder->internal_channel[1];
262	438k	for(i = 0; i < frame_len; i++)
263	438k	{
264	438k	real_t inp0 = input[ch ][i];
265	438k	real_t inp1 = input[ch1][i];
266
267	438k	inp0 *= 65536.0f;
268	438k	inp1 *= 65536.0f;
269	438k	CLIP(inp0, 2147483647.0f, -2147483648.0f);
270	438k	CLIP(inp1, 2147483647.0f, -2147483648.0f);
271
272	438k	(sample_buffer)[(i2)+0] = (int32_t)lrintf(inp0);
273	438k	(sample_buffer)[(i2)+1] = (int32_t)lrintf(inp1);
274	438k	}
275	318	}
276	356	break;
277	407	default:
278	4.00k	for (ch = 0; ch < channels; ch++)
279	3.59k	{
280	4.63M	for(i = 0; i < frame_len; i++)
281	4.62M	{
282	4.62M	real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
283
284	4.62M	inp *= 65536.0f;
285	4.62M	CLIP(inp, 2147483647.0f, -2147483648.0f);
286
287	4.62M	(sample_buffer)[(ichannels)+ch] = (int32_t)lrintf(inp);
288	4.62M	}
289	3.59k	}
290	407	break;
291	763	}
292	763	}
293
294		static void to_PCM_float(NeAACDecStruct hDecoder, real_t *input,
295		uint8_t channels, uint16_t frame_len,
296		float32_t **sample_buffer)
297	292	{
298	292	uint8_t ch, ch1;
299	292	uint16_t i;
300
301	292	switch (CONV(channels,hDecoder->downMatrix))
302	292	{
303	0	case CONV(1,0):
304	0	case CONV(1,1):
305	0	for(i = 0; i < frame_len; i++)
306	0	{
307	0	real_t inp = input[hDecoder->internal_channel[0]][i];
308	0	(sample_buffer)[i] = inpFLOAT_SCALE;
309	0	}
310	0	break;
311	56	case CONV(2,0):
312	56	if (hDecoder->upMatrix)
313	15	{
314	15	ch = hDecoder->internal_channel[0];
315	23.0k	for(i = 0; i < frame_len; i++)
316	23.0k	{
317	23.0k	real_t inp0 = input[ch][i];
318	23.0k	(sample_buffer)[(i2)+0] = inp0*FLOAT_SCALE;
319	23.0k	(sample_buffer)[(i2)+1] = inp0*FLOAT_SCALE;
320	23.0k	}
321	41	} else {
322	41	ch = hDecoder->internal_channel[0];
323	41	ch1 = hDecoder->internal_channel[1];
324	53.4k	for(i = 0; i < frame_len; i++)
325	53.4k	{
326	53.4k	real_t inp0 = input[ch ][i];
327	53.4k	real_t inp1 = input[ch1][i];
328	53.4k	(sample_buffer)[(i2)+0] = inp0*FLOAT_SCALE;
329	53.4k	(sample_buffer)[(i2)+1] = inp1*FLOAT_SCALE;
330	53.4k	}
331	41	}
332	56	break;
333	236	default:
334	1.89k	for (ch = 0; ch < channels; ch++)
335	1.66k	{
336	2.50M	for(i = 0; i < frame_len; i++)
337	2.50M	{
338	2.50M	real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
339	2.50M	(sample_buffer)[(ichannels)+ch] = inp*FLOAT_SCALE;
340	2.50M	}
341	1.66k	}
342	236	break;
343	292	}
344	292	}
345
346		static void to_PCM_double(NeAACDecStruct hDecoder, real_t *input,
347		uint8_t channels, uint16_t frame_len,
348		double **sample_buffer)
349	286	{
350	286	uint8_t ch, ch1;
351	286	uint16_t i;
352
353	286	switch (CONV(channels,hDecoder->downMatrix))
354	286	{
355	0	case CONV(1,0):
356	0	case CONV(1,1):
357	0	for(i = 0; i < frame_len; i++)
358	0	{
359	0	real_t inp = input[hDecoder->internal_channel[0]][i];
360	0	(sample_buffer)[i] = (double)inpFLOAT_SCALE;
361	0	}
362	0	break;
363	62	case CONV(2,0):
364	62	if (hDecoder->upMatrix)
365	20	{
366	20	ch = hDecoder->internal_channel[0];
367	36.6k	for(i = 0; i < frame_len; i++)
368	36.6k	{
369	36.6k	real_t inp0 = input[ch][i];
370	36.6k	(sample_buffer)[(i2)+0] = (double)inp0*FLOAT_SCALE;
371	36.6k	(sample_buffer)[(i2)+1] = (double)inp0*FLOAT_SCALE;
372	36.6k	}
373	42	} else {
374	42	ch = hDecoder->internal_channel[0];
375	42	ch1 = hDecoder->internal_channel[1];
376	60.5k	for(i = 0; i < frame_len; i++)
377	60.4k	{
378	60.4k	real_t inp0 = input[ch ][i];
379	60.4k	real_t inp1 = input[ch1][i];
380	60.4k	(sample_buffer)[(i2)+0] = (double)inp0*FLOAT_SCALE;
381	60.4k	(sample_buffer)[(i2)+1] = (double)inp1*FLOAT_SCALE;
382	60.4k	}
383	42	}
384	62	break;
385	224	default:
386	2.68k	for (ch = 0; ch < channels; ch++)
387	2.46k	{
388	3.91M	for(i = 0; i < frame_len; i++)
389	3.90M	{
390	3.90M	real_t inp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->internal_channel);
391	3.90M	(sample_buffer)[(ichannels)+ch] = (double)inp*FLOAT_SCALE;
392	3.90M	}
393	2.46k	}
394	224	break;
395	286	}
396	286	}
397
398		void output_to_PCM(NeAACDecStruct hDecoder,
399		real_t *input, void sample_buffer, uint8_t channels,
400		uint16_t frame_len, uint8_t format)
401	3.10k	{
402	3.10k	int16_t short_sample_buffer = (int16_t)sample_buffer;
403	3.10k	int32_t int_sample_buffer = (int32_t)sample_buffer;
404	3.10k	float32_t float_sample_buffer = (float32_t)sample_buffer;
405	3.10k	double double_sample_buffer = (double)sample_buffer;
406
407		#ifdef PROFILE
408		int64_t count = faad_get_ts();
409		#endif
410
411		/* Copy output to a standard PCM buffer */
412	3.10k	switch (format)
413	3.10k	{
414	954	case FAAD_FMT_16BIT:
415	954	to_PCM_16bit(hDecoder, input, channels, frame_len, &short_sample_buffer);
416	954	break;
417	805	case FAAD_FMT_24BIT:
418	805	to_PCM_24bit(hDecoder, input, channels, frame_len, &int_sample_buffer);
419	805	break;
420	763	case FAAD_FMT_32BIT:
421	763	to_PCM_32bit(hDecoder, input, channels, frame_len, &int_sample_buffer);
422	763	break;
423	292	case FAAD_FMT_FLOAT:
424	292	to_PCM_float(hDecoder, input, channels, frame_len, &float_sample_buffer);
425	292	break;
426	286	case FAAD_FMT_DOUBLE:
427	286	to_PCM_double(hDecoder, input, channels, frame_len, &double_sample_buffer);
428	286	break;
429	3.10k	}
430
431		#ifdef PROFILE
432		count = faad_get_ts() - count;
433		hDecoder->output_cycles += count;
434		#endif
435
436	3.10k	return sample_buffer;
437	3.10k	}
438
439		#else
440
441		#define DM_MUL FRAC_CONST(0.3203772410170407) // 1/(1+sqrt(2) + 1/sqrt(2))
442		#define RSQRT2 FRAC_CONST(0.7071067811865475244) // 1/sqrt(2)
443		#define BOTH FRAC_CONST(0.2265409196609864215998) // 1/(sqrt(2) + 2 + 1)
444
445		static INLINE real_t get_sample(real_t **input, uint8_t channel, uint16_t sample,
446		uint8_t down_matrix, uint8_t up_matrix,
447		uint8_t *internal_channel)
448		{
449		real_t C;
450		if (up_matrix == 1)
451		return input[internal_channel[0]][sample];
452
453		if (!down_matrix)
454		return input[internal_channel[channel]][sample];
455
456		C = MUL_F(input[internal_channel[0]][sample], BOTH);
457		if (channel == 0)
458		{
459		real_t L_S = MUL_F(input[internal_channel[3]][sample], BOTH);
460		real_t core = MUL_F(input[internal_channel[1]][sample], DM_MUL);
461		return core + C + L_S;
462		} else {
463		real_t R_S = MUL_F(input[internal_channel[4]][sample], BOTH);
464		real_t core = MUL_F(input[internal_channel[2]][sample], DM_MUL);
465		return core + C + R_S;
466		}
467		}
468
469		void* output_to_PCM(NeAACDecStruct *hDecoder,
470		real_t *input, void sample_buffer, uint8_t channels,
471		uint16_t frame_len, uint8_t format)
472		{
473		uint8_t ch;
474		uint16_t i;
475		int16_t short_sample_buffer = (int16_t)sample_buffer;
476		int32_t int_sample_buffer = (int32_t)sample_buffer;
477		int32_t exp, half, sat_shift_mask;
478
479		/* Copy output to a standard PCM buffer */
480		for (ch = 0; ch < channels; ch++)
481		{
482		switch (format)
483		{
484		case FAAD_FMT_16BIT:
485		for(i = 0; i < frame_len; i++)
486		{
487		int32_t tmp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->upMatrix,
488		hDecoder->internal_channel);
489		if (tmp >= 0)
490		{
491		if (tmp <= 0x7FFFFFFF - (1 << (REAL_BITS-1)))
492		tmp += (1 << (REAL_BITS-1));
493		if (tmp >= REAL_CONST(32767))
494		{
495		tmp = REAL_CONST(32767);
496		}
497		} else {
498		if (tmp >= (int32_t)0x80000000 + (1 << (REAL_BITS-1)))
499		tmp += -(1 << (REAL_BITS-1));
500		if (tmp <= REAL_CONST(-32768))
501		{
502		tmp = REAL_CONST(-32768);
503		}
504		}
505		tmp >>= REAL_BITS;
506		short_sample_buffer[(i*channels)+ch] = (int16_t)tmp;
507		}
508		break;
509		case FAAD_FMT_24BIT:
510		for(i = 0; i < frame_len; i++)
511		{
512		int32_t tmp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->upMatrix,
513		hDecoder->internal_channel);
514		if (tmp >= 0)
515		{
516		if (tmp <= 0x7FFFFFFF - (1 << (REAL_BITS-9)))
517		tmp += (1 << (REAL_BITS-9));
518		tmp >>= (REAL_BITS-8);
519		if (tmp >= 8388607)
520		{
521		tmp = 8388607;
522		}
523		} else {
524		if (tmp >= (int32_t)0x80000000 + (1 << (REAL_BITS-9)))
525		tmp += -(1 << (REAL_BITS-9));
526		tmp >>= (REAL_BITS-8);
527		if (tmp <= -8388608)
528		{
529		tmp = -8388608;
530		}
531		}
532		int_sample_buffer[(i*channels)+ch] = (int32_t)tmp;
533		}
534		break;
535		case FAAD_FMT_32BIT:
536		exp = 16 - REAL_BITS;
537		half = 1 << (exp - 1);
538		sat_shift_mask = SAT_SHIFT_MASK(exp);
539		for(i = 0; i < frame_len; i++)
540		{
541		int32_t tmp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->upMatrix,
542		hDecoder->internal_channel);
543		if (tmp >= 0)
544		{
545		if (tmp <= 0x7FFFFFFF - half)
546		tmp += half;
547		} else {
548		if (tmp >= (int32_t)0x80000000 + half)
549		tmp += -half;
550		}
551		tmp = SAT_SHIFT(tmp, exp, sat_shift_mask);
552		int_sample_buffer[(i*channels)+ch] = tmp;
553		}
554		break;
555		case FAAD_FMT_FIXED:
556		for(i = 0; i < frame_len; i++)
557		{
558		real_t tmp = get_sample(input, ch, i, hDecoder->downMatrix, hDecoder->upMatrix,
559		hDecoder->internal_channel);
560		int_sample_buffer[(i*channels)+ch] = (int32_t)tmp;
561		}
562		break;
563		}
564		}
565
566		return sample_buffer;
567		}
568
569		#endif