dcadsp.c 4.25 KB
Newer Older
1 2 3 4
/*
 * Copyright (c) 2004 Gildas Bazin
 * Copyright (c) 2010 Mans Rullgard <mans@mansr.com>
 *
5
 * This file is part of Libav.
6
 *
7
 * Libav is free software; you can redistribute it and/or
8 9 10 11
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
12
 * Libav is distributed in the hope that it will be useful,
13 14 15 16 17
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
18
 * License along with Libav; if not, write to the Free Software
19 20 21
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
 */

22
#include "config.h"
23

24
#include "libavutil/attributes.h"
25
#include "libavutil/intreadwrite.h"
26

27
#include "dcadsp.h"
28
#include "dcamath.h"
29

30
static void decode_hf_c(int32_t dst[DCA_SUBBANDS][SAMPLES_PER_SUBBAND],
31 32 33 34
                        const int32_t vq_num[DCA_SUBBANDS],
                        const int8_t hf_vq[1024][32], intptr_t vq_offset,
                        int32_t scale[DCA_SUBBANDS][2],
                        intptr_t start, intptr_t end)
35 36 37 38 39 40 41 42 43 44
{
    int i, j;

    for (j = start; j < end; j++) {
        const int8_t *ptr = &hf_vq[vq_num[j]][vq_offset];
        for (i = 0; i < 8; i++)
            dst[j][i] = ptr[i] * scale[j][0] + 8 >> 4;
    }
}

45 46
static inline void dca_lfe_fir(float *out, const float *in, const float *coefs,
                               int decifactor)
47
{
48 49
    float *out2    = out + 2 * decifactor - 1;
    int num_coeffs = 256 / decifactor;
50 51 52 53 54 55
    int j, k;

    /* One decimated sample generates 2*decifactor interpolated ones */
    for (k = 0; k < decifactor; k++) {
        float v0 = 0.0;
        float v1 = 0.0;
56
        for (j = 0; j < num_coeffs; j++, coefs++) {
57
            v0 += in[-j]                 * *coefs;
58
            v1 += in[j + 1 - num_coeffs] * *coefs;
59
        }
60
        *out++  = v0;
61
        *out2-- = v1;
62 63 64
    }
}

65
static void dca_qmf_32_subbands(float samples_in[DCA_SUBBANDS][SAMPLES_PER_SUBBAND], int sb_act,
66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87
                                SynthFilterContext *synth, FFTContext *imdct,
                                float synth_buf_ptr[512],
                                int *synth_buf_offset, float synth_buf2[32],
                                const float window[512], float *samples_out,
                                float raXin[32], float scale)
{
    int i;
    int subindex;

    for (i = sb_act; i < 32; i++)
        raXin[i] = 0.0;

    /* Reconstructed channel sample index */
    for (subindex = 0; subindex < 8; subindex++) {
        /* Load in one sample from each subband and clear inactive subbands */
        for (i = 0; i < sb_act; i++) {
            unsigned sign = (i - 1) & 2;
            uint32_t v    = AV_RN32A(&samples_in[i][subindex]) ^ sign << 30;
            AV_WN32A(&raXin[i], v);
        }

        synth->synth_filter_float(imdct, synth_buf_ptr, synth_buf_offset,
88 89
                                  synth_buf2, window, samples_out, raXin,
                                  scale);
90 91 92 93
        samples_out += 32;
    }
}

94 95 96 97 98 99 100 101 102 103 104 105
static void dequantize_c(int32_t *samples, uint32_t step_size, uint32_t scale)
{
    int64_t step = (int64_t)step_size * scale;
    int shift, i;
    int32_t step_scale;

    if (step > (1 << 23))
        shift = av_log2(step >> 23) + 1;
    else
        shift = 0;
    step_scale = (int32_t)(step >> shift);

106
    for (i = 0; i < SAMPLES_PER_SUBBAND; i++)
107 108 109
        samples[i] = dca_clip23(dca_norm((int64_t)samples[i] * step_scale, 22 - shift));
}

110
static void dca_lfe_fir0_c(float *out, const float *in, const float *coefs)
111
{
112
    dca_lfe_fir(out, in, coefs, 32);
113 114
}

115
static void dca_lfe_fir1_c(float *out, const float *in, const float *coefs)
116
{
117
    dca_lfe_fir(out, in, coefs, 64);
118 119
}

120
av_cold void ff_dcadsp_init(DCADSPContext *s)
121
{
122 123
    s->lfe_fir[0]      = dca_lfe_fir0_c;
    s->lfe_fir[1]      = dca_lfe_fir1_c;
124
    s->qmf_32_subbands = dca_qmf_32_subbands;
125
    s->decode_hf       = decode_hf_c;
126
    s->dequantize      = dequantize_c;
127

128 129
    if (ARCH_AARCH64)
        ff_dcadsp_init_aarch64(s);
130 131 132 133
    if (ARCH_ARM)
        ff_dcadsp_init_arm(s);
    if (ARCH_X86)
        ff_dcadsp_init_x86(s);
134
}