dcaenc.c 35.5 KB
Newer Older
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1 2
/*
 * DCA encoder
Paul B Mahol's avatar
Paul B Mahol committed
3
 * Copyright (C) 2008-2012 Alexander E. Patrakov
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 *               2010 Benjamin Larsson
 *               2011 Xiang Wang
 *
 * This file is part of FFmpeg.
 *
 * FFmpeg is free software; you can redistribute it and/or
 * 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.
 *
 * FFmpeg 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
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with FFmpeg; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
 */

Paul B Mahol's avatar
Paul B Mahol committed
24
#include "libavutil/avassert.h"
25
#include "libavutil/channel_layout.h"
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
26
#include "libavutil/common.h"
27
#include "libavutil/ffmath.h"
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
28
#include "avcodec.h"
Paul B Mahol's avatar
Paul B Mahol committed
29 30 31
#include "dca.h"
#include "dcadata.h"
#include "dcaenc.h"
32
#include "internal.h"
33
#include "mathops.h"
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
34 35 36
#include "put_bits.h"

#define MAX_CHANNELS 6
Paul B Mahol's avatar
Paul B Mahol committed
37
#define DCA_MAX_FRAME_SIZE 16384
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
38
#define DCA_HEADER_SIZE 13
Paul B Mahol's avatar
Paul B Mahol committed
39
#define DCA_LFE_SAMPLES 8
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
40

41
#define DCAENC_SUBBANDS 32
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
42
#define SUBFRAMES 1
Paul B Mahol's avatar
Paul B Mahol committed
43 44 45
#define SUBSUBFRAMES 2
#define SUBBAND_SAMPLES (SUBFRAMES * SUBSUBFRAMES * 8)
#define AUBANDS 25
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
46

47
typedef struct DCAEncContext {
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
48 49
    PutBitContext pb;
    int frame_size;
Paul B Mahol's avatar
Paul B Mahol committed
50 51 52
    int frame_bits;
    int fullband_channels;
    int channels;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
53
    int lfe_channel;
Paul B Mahol's avatar
Paul B Mahol committed
54 55 56 57 58
    int samplerate_index;
    int bitrate_index;
    int channel_config;
    const int32_t *band_interpolation;
    const int32_t *band_spectrum;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
59
    int lfe_scale_factor;
Paul B Mahol's avatar
Paul B Mahol committed
60 61
    softfloat lfe_quant;
    int32_t lfe_peak_cb;
62
    const int8_t *channel_order_tab;  ///< channel reordering table, lfe and non lfe
Paul B Mahol's avatar
Paul B Mahol committed
63

64 65 66 67
    int32_t history[MAX_CHANNELS][512]; /* This is a circular buffer */
    int32_t subband[MAX_CHANNELS][DCAENC_SUBBANDS][SUBBAND_SAMPLES];
    int32_t quantized[MAX_CHANNELS][DCAENC_SUBBANDS][SUBBAND_SAMPLES];
    int32_t peak_cb[MAX_CHANNELS][DCAENC_SUBBANDS];
Paul B Mahol's avatar
Paul B Mahol committed
68 69
    int32_t downsampled_lfe[DCA_LFE_SAMPLES];
    int32_t masking_curve_cb[SUBSUBFRAMES][256];
70
    int32_t bit_allocation_sel[MAX_CHANNELS];
71 72 73
    int abits[MAX_CHANNELS][DCAENC_SUBBANDS];
    int scale_factor[MAX_CHANNELS][DCAENC_SUBBANDS];
    softfloat quant[MAX_CHANNELS][DCAENC_SUBBANDS];
74
    int32_t quant_index_sel[MAX_CHANNELS][DCA_CODE_BOOKS];
Paul B Mahol's avatar
Paul B Mahol committed
75 76 77 78 79
    int32_t eff_masking_curve_cb[256];
    int32_t band_masking_cb[32];
    int32_t worst_quantization_noise;
    int32_t worst_noise_ever;
    int consumed_bits;
80
} DCAEncContext;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
81

Paul B Mahol's avatar
Paul B Mahol committed
82 83 84 85 86 87 88
static int32_t cos_table[2048];
static int32_t band_interpolation[2][512];
static int32_t band_spectrum[2][8];
static int32_t auf[9][AUBANDS][256];
static int32_t cb_to_add[256];
static int32_t cb_to_level[2048];
static int32_t lfe_fir_64i[512];
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
89

Paul B Mahol's avatar
Paul B Mahol committed
90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111
/* Transfer function of outer and middle ear, Hz -> dB */
static double hom(double f)
{
    double f1 = f / 1000;

    return -3.64 * pow(f1, -0.8)
           + 6.8 * exp(-0.6 * (f1 - 3.4) * (f1 - 3.4))
           - 6.0 * exp(-0.15 * (f1 - 8.7) * (f1 - 8.7))
           - 0.0006 * (f1 * f1) * (f1 * f1);
}

static double gammafilter(int i, double f)
{
    double h = (f - fc[i]) / erb[i];

    h = 1 + h * h;
    h = 1 / (h * h);
    return 20 * log10(h);
}

static int encode_init(AVCodecContext *avctx)
{
112
    DCAEncContext *c = avctx->priv_data;
Paul B Mahol's avatar
Paul B Mahol committed
113
    uint64_t layout = avctx->channel_layout;
114
    int i, j, min_frame_bits;
Paul B Mahol's avatar
Paul B Mahol committed
115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139

    c->fullband_channels = c->channels = avctx->channels;
    c->lfe_channel = (avctx->channels == 3 || avctx->channels == 6);
    c->band_interpolation = band_interpolation[1];
    c->band_spectrum = band_spectrum[1];
    c->worst_quantization_noise = -2047;
    c->worst_noise_ever = -2047;

    if (!layout) {
        av_log(avctx, AV_LOG_WARNING, "No channel layout specified. The "
                                      "encoder will guess the layout, but it "
                                      "might be incorrect.\n");
        layout = av_get_default_channel_layout(avctx->channels);
    }
    switch (layout) {
    case AV_CH_LAYOUT_MONO:         c->channel_config = 0; break;
    case AV_CH_LAYOUT_STEREO:       c->channel_config = 2; break;
    case AV_CH_LAYOUT_2_2:          c->channel_config = 8; break;
    case AV_CH_LAYOUT_5POINT0:      c->channel_config = 9; break;
    case AV_CH_LAYOUT_5POINT1:      c->channel_config = 9; break;
    default:
        av_log(avctx, AV_LOG_ERROR, "Unsupported channel layout!\n");
        return AVERROR_PATCHWELCOME;
    }

140
    if (c->lfe_channel) {
Paul B Mahol's avatar
Paul B Mahol committed
141
        c->fullband_channels--;
142
        c->channel_order_tab = channel_reorder_lfe[c->channel_config];
143
    } else {
144
        c->channel_order_tab = channel_reorder_nolfe[c->channel_config];
145
    }
Paul B Mahol's avatar
Paul B Mahol committed
146

147 148 149 150
    for (i = 0; i < MAX_CHANNELS; i++) {
        for (j = 0; j < DCA_CODE_BOOKS; j++) {
            c->quant_index_sel[i][j] = ff_dca_quant_index_group_size[j];
        }
151 152
        /* 6 - no Huffman */
        c->bit_allocation_sel[i] = 6;
153 154
    }

Paul B Mahol's avatar
Paul B Mahol committed
155 156 157 158 159 160 161 162 163
    for (i = 0; i < 9; i++) {
        if (sample_rates[i] == avctx->sample_rate)
            break;
    }
    if (i == 9)
        return AVERROR(EINVAL);
    c->samplerate_index = i;

    if (avctx->bit_rate < 32000 || avctx->bit_rate > 3840000) {
164
        av_log(avctx, AV_LOG_ERROR, "Bit rate %"PRId64" not supported.", (int64_t)avctx->bit_rate);
Paul B Mahol's avatar
Paul B Mahol committed
165 166
        return AVERROR(EINVAL);
    }
167
    for (i = 0; ff_dca_bit_rates[i] < avctx->bit_rate; i++)
Paul B Mahol's avatar
Paul B Mahol committed
168 169 170 171 172 173 174 175 176 177 178 179 180 181
        ;
    c->bitrate_index = i;
    c->frame_bits = FFALIGN((avctx->bit_rate * 512 + avctx->sample_rate - 1) / avctx->sample_rate, 32);
    min_frame_bits = 132 + (493 + 28 * 32) * c->fullband_channels + c->lfe_channel * 72;
    if (c->frame_bits < min_frame_bits || c->frame_bits > (DCA_MAX_FRAME_SIZE << 3))
        return AVERROR(EINVAL);

    c->frame_size = (c->frame_bits + 7) / 8;

    avctx->frame_size = 32 * SUBBAND_SAMPLES;

    if (!cos_table[0]) {
        int j, k;

182 183 184 185
        cos_table[0] = 0x7fffffff;
        cos_table[512] = 0;
        cos_table[1024] = -cos_table[0];
        for (i = 1; i < 512; i++) {
Paul B Mahol's avatar
Paul B Mahol committed
186
            cos_table[i]   = (int32_t)(0x7fffffff * cos(M_PI * i / 1024));
187 188 189 190 191
            cos_table[1024-i] = -cos_table[i];
            cos_table[1024+i] = -cos_table[i];
            cos_table[2048-i] = cos_table[i];
        }
        for (i = 0; i < 2048; i++) {
192
            cb_to_level[i] = (int32_t)(0x7fffffff * ff_exp10(-0.005 * i));
Paul B Mahol's avatar
Paul B Mahol committed
193 194
        }

195 196 197 198 199
        for (k = 0; k < 32; k++) {
            for (j = 0; j < 8; j++) {
                lfe_fir_64i[64 * j + k] = (int32_t)(0xffffff800000ULL * ff_dca_lfe_fir_64[8 * k + j]);
                lfe_fir_64i[64 * (7-j) + (63 - k)] = (int32_t)(0xffffff800000ULL * ff_dca_lfe_fir_64[8 * k + j]);
            }
200 201
        }

Paul B Mahol's avatar
Paul B Mahol committed
202
        for (i = 0; i < 512; i++) {
203 204
            band_interpolation[0][i] = (int32_t)(0x1000000000ULL * ff_dca_fir_32bands_perfect[i]);
            band_interpolation[1][i] = (int32_t)(0x1000000000ULL * ff_dca_fir_32bands_nonperfect[i]);
Paul B Mahol's avatar
Paul B Mahol committed
205 206 207 208 209 210 211 212 213 214 215 216 217
        }

        for (i = 0; i < 9; i++) {
            for (j = 0; j < AUBANDS; j++) {
                for (k = 0; k < 256; k++) {
                    double freq = sample_rates[i] * (k + 0.5) / 512;

                    auf[i][j][k] = (int32_t)(10 * (hom(freq) + gammafilter(j, freq)));
                }
            }
        }

        for (i = 0; i < 256; i++) {
218
            double add = 1 + ff_exp10(-0.01 * i);
Paul B Mahol's avatar
Paul B Mahol committed
219 220 221 222 223
            cb_to_add[i] = (int32_t)(100 * log10(add));
        }
        for (j = 0; j < 8; j++) {
            double accum = 0;
            for (i = 0; i < 512; i++) {
224
                double reconst = ff_dca_fir_32bands_perfect[i] * ((i & 64) ? (-1) : 1);
Paul B Mahol's avatar
Paul B Mahol committed
225 226 227 228 229 230 231
                accum += reconst * cos(2 * M_PI * (i + 0.5 - 256) * (j + 0.5) / 512);
            }
            band_spectrum[0][j] = (int32_t)(200 * log10(accum));
        }
        for (j = 0; j < 8; j++) {
            double accum = 0;
            for (i = 0; i < 512; i++) {
232
                double reconst = ff_dca_fir_32bands_nonperfect[i] * ((i & 64) ? (-1) : 1);
Paul B Mahol's avatar
Paul B Mahol committed
233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249
                accum += reconst * cos(2 * M_PI * (i + 0.5 - 256) * (j + 0.5) / 512);
            }
            band_spectrum[1][j] = (int32_t)(200 * log10(accum));
        }
    }
    return 0;
}

static inline int32_t cos_t(int x)
{
    return cos_table[x & 2047];
}

static inline int32_t sin_t(int x)
{
    return cos_t(x - 512);
}
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
250

Paul B Mahol's avatar
Paul B Mahol committed
251 252 253 254
static inline int32_t half32(int32_t a)
{
    return (a + 1) >> 1;
}
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
255 256 257

static inline int32_t mul32(int32_t a, int32_t b)
{
Paul B Mahol's avatar
Paul B Mahol committed
258 259 260 261
    int64_t r = (int64_t)a * b + 0x80000000ULL;
    return r >> 32;
}

262
static void subband_transform(DCAEncContext *c, const int32_t *input)
Paul B Mahol's avatar
Paul B Mahol committed
263 264 265 266 267 268 269
{
    int ch, subs, i, k, j;

    for (ch = 0; ch < c->fullband_channels; ch++) {
        /* History is copied because it is also needed for PSY */
        int32_t hist[512];
        int hist_start = 0;
270
        const int chi = c->channel_order_tab[ch];
Paul B Mahol's avatar
Paul B Mahol committed
271

272
        memcpy(hist, &c->history[ch][0], 512 * sizeof(int32_t));
Paul B Mahol's avatar
Paul B Mahol committed
273 274 275 276 277 278 279

        for (subs = 0; subs < SUBBAND_SAMPLES; subs++) {
            int32_t accum[64];
            int32_t resp;
            int band;

            /* Calculate the convolutions at once */
280
            memset(accum, 0, 64 * sizeof(int32_t));
Paul B Mahol's avatar
Paul B Mahol committed
281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299

            for (k = 0, i = hist_start, j = 0;
                    i < 512; k = (k + 1) & 63, i++, j++)
                accum[k] += mul32(hist[i], c->band_interpolation[j]);
            for (i = 0; i < hist_start; k = (k + 1) & 63, i++, j++)
                accum[k] += mul32(hist[i], c->band_interpolation[j]);

            for (k = 16; k < 32; k++)
                accum[k] = accum[k] - accum[31 - k];
            for (k = 32; k < 48; k++)
                accum[k] = accum[k] + accum[95 - k];

            for (band = 0; band < 32; band++) {
                resp = 0;
                for (i = 16; i < 48; i++) {
                    int s = (2 * band + 1) * (2 * (i + 16) + 1);
                    resp += mul32(accum[i], cos_t(s << 3)) >> 3;
                }

300
                c->subband[ch][band][subs] = ((band + 1) & 2) ? -resp : resp;
Paul B Mahol's avatar
Paul B Mahol committed
301 302 303 304
            }

            /* Copy in 32 new samples from input */
            for (i = 0; i < 32; i++)
305
                hist[i + hist_start] = input[(subs * 32 + i) * c->channels + chi];
306

Paul B Mahol's avatar
Paul B Mahol committed
307 308 309 310 311
            hist_start = (hist_start + 32) & 511;
        }
    }
}

312
static void lfe_downsample(DCAEncContext *c, const int32_t *input)
Paul B Mahol's avatar
Paul B Mahol committed
313 314
{
    /* FIXME: make 128x LFE downsampling possible */
315
    const int lfech = lfe_index[c->channel_config];
Paul B Mahol's avatar
Paul B Mahol committed
316 317 318 319 320
    int i, j, lfes;
    int32_t hist[512];
    int32_t accum;
    int hist_start = 0;

321
    memcpy(hist, &c->history[c->channels - 1][0], 512 * sizeof(int32_t));
Paul B Mahol's avatar
Paul B Mahol committed
322 323 324 325 326 327 328 329 330 331 332 333 334 335

    for (lfes = 0; lfes < DCA_LFE_SAMPLES; lfes++) {
        /* Calculate the convolution */
        accum = 0;

        for (i = hist_start, j = 0; i < 512; i++, j++)
            accum += mul32(hist[i], lfe_fir_64i[j]);
        for (i = 0; i < hist_start; i++, j++)
            accum += mul32(hist[i], lfe_fir_64i[j]);

        c->downsampled_lfe[lfes] = accum;

        /* Copy in 64 new samples from input */
        for (i = 0; i < 64; i++)
336
            hist[i + hist_start] = input[(lfes * 64 + i) * c->channels + lfech];
Paul B Mahol's avatar
Paul B Mahol committed
337 338 339

        hist_start = (hist_start + 64) & 511;
    }
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
340 341
}

Paul B Mahol's avatar
Paul B Mahol committed
342 343 344 345
typedef struct {
    int32_t re;
    int32_t im;
} cplx32;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
346

Paul B Mahol's avatar
Paul B Mahol committed
347
static void fft(const int32_t in[2 * 256], cplx32 out[256])
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
348
{
Paul B Mahol's avatar
Paul B Mahol committed
349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410
    cplx32 buf[256], rin[256], rout[256];
    int i, j, k, l;

    /* do two transforms in parallel */
    for (i = 0; i < 256; i++) {
        /* Apply the Hann window */
        rin[i].re = mul32(in[2 * i], 0x3fffffff - (cos_t(8 * i + 2) >> 1));
        rin[i].im = mul32(in[2 * i + 1], 0x3fffffff - (cos_t(8 * i + 6) >> 1));
    }
    /* pre-rotation */
    for (i = 0; i < 256; i++) {
        buf[i].re = mul32(cos_t(4 * i + 2), rin[i].re)
                  - mul32(sin_t(4 * i + 2), rin[i].im);
        buf[i].im = mul32(cos_t(4 * i + 2), rin[i].im)
                  + mul32(sin_t(4 * i + 2), rin[i].re);
    }

    for (j = 256, l = 1; j != 1; j >>= 1, l <<= 1) {
        for (k = 0; k < 256; k += j) {
            for (i = k; i < k + j / 2; i++) {
                cplx32 sum, diff;
                int t = 8 * l * i;

                sum.re = buf[i].re + buf[i + j / 2].re;
                sum.im = buf[i].im + buf[i + j / 2].im;

                diff.re = buf[i].re - buf[i + j / 2].re;
                diff.im = buf[i].im - buf[i + j / 2].im;

                buf[i].re = half32(sum.re);
                buf[i].im = half32(sum.im);

                buf[i + j / 2].re = mul32(diff.re, cos_t(t))
                                  - mul32(diff.im, sin_t(t));
                buf[i + j / 2].im = mul32(diff.im, cos_t(t))
                                  + mul32(diff.re, sin_t(t));
            }
        }
    }
    /* post-rotation */
    for (i = 0; i < 256; i++) {
        int b = ff_reverse[i];
        rout[i].re = mul32(buf[b].re, cos_t(4 * i))
                   - mul32(buf[b].im, sin_t(4 * i));
        rout[i].im = mul32(buf[b].im, cos_t(4 * i))
                   + mul32(buf[b].re, sin_t(4 * i));
    }
    for (i = 0; i < 256; i++) {
        /* separate the results of the two transforms */
        cplx32 o1, o2;

        o1.re =  rout[i].re - rout[255 - i].re;
        o1.im =  rout[i].im + rout[255 - i].im;

        o2.re =  rout[i].im - rout[255 - i].im;
        o2.im = -rout[i].re - rout[255 - i].re;

        /* combine them into one long transform */
        out[i].re = mul32( o1.re + o2.re, cos_t(2 * i + 1))
                  + mul32( o1.im - o2.im, sin_t(2 * i + 1));
        out[i].im = mul32( o1.im + o2.im, cos_t(2 * i + 1))
                  + mul32(-o1.re + o2.re, sin_t(2 * i + 1));
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
411
    }
Paul B Mahol's avatar
Paul B Mahol committed
412
}
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
413

Paul B Mahol's avatar
Paul B Mahol committed
414 415 416 417 418 419 420 421 422 423
static int32_t get_cb(int32_t in)
{
    int i, res;

    res = 0;
    if (in < 0)
        in = -in;
    for (i = 1024; i > 0; i >>= 1) {
        if (cb_to_level[i + res] >= in)
            res += i;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
424
    }
Paul B Mahol's avatar
Paul B Mahol committed
425
    return -res;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
426 427
}

Paul B Mahol's avatar
Paul B Mahol committed
428
static int32_t add_cb(int32_t a, int32_t b)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
429
{
Paul B Mahol's avatar
Paul B Mahol committed
430 431 432 433 434 435
    if (a < b)
        FFSWAP(int32_t, a, b);

    if (a - b >= 256)
        return a;
    return a + cb_to_add[a - b];
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
436 437
}

Paul B Mahol's avatar
Paul B Mahol committed
438 439
static void adjust_jnd(int samplerate_index,
                       const int32_t in[512], int32_t out_cb[256])
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
440
{
Paul B Mahol's avatar
Paul B Mahol committed
441 442 443 444 445 446 447 448 449
    int32_t power[256];
    cplx32 out[256];
    int32_t out_cb_unnorm[256];
    int32_t denom;
    const int32_t ca_cb = -1114;
    const int32_t cs_cb = 928;
    int i, j;

    fft(in, out);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
450

Paul B Mahol's avatar
Paul B Mahol committed
451 452 453
    for (j = 0; j < 256; j++) {
        power[j] = add_cb(get_cb(out[j].re), get_cb(out[j].im));
        out_cb_unnorm[j] = -2047; /* and can only grow */
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
454
    }
Paul B Mahol's avatar
Paul B Mahol committed
455 456 457 458 459 460 461 462 463 464 465 466

    for (i = 0; i < AUBANDS; i++) {
        denom = ca_cb; /* and can only grow */
        for (j = 0; j < 256; j++)
            denom = add_cb(denom, power[j] + auf[samplerate_index][i][j]);
        for (j = 0; j < 256; j++)
            out_cb_unnorm[j] = add_cb(out_cb_unnorm[j],
                    -denom + auf[samplerate_index][i][j]);
    }

    for (j = 0; j < 256; j++)
        out_cb[j] = add_cb(out_cb[j], -out_cb_unnorm[j] - ca_cb - cs_cb);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
467 468
}

469
typedef void (*walk_band_t)(DCAEncContext *c, int band1, int band2, int f,
Paul B Mahol's avatar
Paul B Mahol committed
470 471 472
                            int32_t spectrum1, int32_t spectrum2, int channel,
                            int32_t * arg);

473
static void walk_band_low(DCAEncContext *c, int band, int channel,
Paul B Mahol's avatar
Paul B Mahol committed
474
                          walk_band_t walk, int32_t *arg)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
475
{
Paul B Mahol's avatar
Paul B Mahol committed
476
    int f;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
477

Paul B Mahol's avatar
Paul B Mahol committed
478 479 480 481 482 483 484 485 486
    if (band == 0) {
        for (f = 0; f < 4; f++)
            walk(c, 0, 0, f, 0, -2047, channel, arg);
    } else {
        for (f = 0; f < 8; f++)
            walk(c, band, band - 1, 8 * band - 4 + f,
                    c->band_spectrum[7 - f], c->band_spectrum[f], channel, arg);
    }
}
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
487

488
static void walk_band_high(DCAEncContext *c, int band, int channel,
Paul B Mahol's avatar
Paul B Mahol committed
489 490 491
                           walk_band_t walk, int32_t *arg)
{
    int f;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
492

Paul B Mahol's avatar
Paul B Mahol committed
493 494 495 496 497 498 499 500 501
    if (band == 31) {
        for (f = 0; f < 4; f++)
            walk(c, 31, 31, 256 - 4 + f, 0, -2047, channel, arg);
    } else {
        for (f = 0; f < 8; f++)
            walk(c, band, band + 1, 8 * band + 4 + f,
                    c->band_spectrum[f], c->band_spectrum[7 - f], channel, arg);
    }
}
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
502

503
static void update_band_masking(DCAEncContext *c, int band1, int band2,
Paul B Mahol's avatar
Paul B Mahol committed
504 505 506 507
                                int f, int32_t spectrum1, int32_t spectrum2,
                                int channel, int32_t * arg)
{
    int32_t value = c->eff_masking_curve_cb[f] - spectrum1;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
508

Paul B Mahol's avatar
Paul B Mahol committed
509 510 511 512
    if (value < c->band_masking_cb[band1])
        c->band_masking_cb[band1] = value;
}

513
static void calc_masking(DCAEncContext *c, const int32_t *input)
Paul B Mahol's avatar
Paul B Mahol committed
514 515 516 517 518 519 520 521 522 523
{
    int i, k, band, ch, ssf;
    int32_t data[512];

    for (i = 0; i < 256; i++)
        for (ssf = 0; ssf < SUBSUBFRAMES; ssf++)
            c->masking_curve_cb[ssf][i] = -2047;

    for (ssf = 0; ssf < SUBSUBFRAMES; ssf++)
        for (ch = 0; ch < c->fullband_channels; ch++) {
524 525
            const int chi = c->channel_order_tab[ch];

Paul B Mahol's avatar
Paul B Mahol committed
526
            for (i = 0, k = 128 + 256 * ssf; k < 512; i++, k++)
527
                data[i] = c->history[ch][k];
Paul B Mahol's avatar
Paul B Mahol committed
528
            for (k -= 512; i < 512; i++, k++)
529
                data[i] = input[k * c->channels + chi];
Paul B Mahol's avatar
Paul B Mahol committed
530 531 532 533 534 535 536 537 538 539 540 541 542 543 544
            adjust_jnd(c->samplerate_index, data, c->masking_curve_cb[ssf]);
        }
    for (i = 0; i < 256; i++) {
        int32_t m = 2048;

        for (ssf = 0; ssf < SUBSUBFRAMES; ssf++)
            if (c->masking_curve_cb[ssf][i] < m)
                m = c->masking_curve_cb[ssf][i];
        c->eff_masking_curve_cb[i] = m;
    }

    for (band = 0; band < 32; band++) {
        c->band_masking_cb[band] = 2048;
        walk_band_low(c, band, 0, update_band_masking, NULL);
        walk_band_high(c, band, 0, update_band_masking, NULL);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
545 546 547
    }
}

548
static void find_peaks(DCAEncContext *c)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
549
{
Paul B Mahol's avatar
Paul B Mahol committed
550 551
    int band, ch;

552 553
    for (ch = 0; ch < c->fullband_channels; ch++)
        for (band = 0; band < 32; band++) {
Paul B Mahol's avatar
Paul B Mahol committed
554 555 556 557
            int sample;
            int32_t m = 0;

            for (sample = 0; sample < SUBBAND_SAMPLES; sample++) {
558
                int32_t s = abs(c->subband[ch][band][sample]);
Paul B Mahol's avatar
Paul B Mahol committed
559 560 561
                if (m < s)
                    m = s;
            }
562
            c->peak_cb[ch][band] = get_cb(m);
Paul B Mahol's avatar
Paul B Mahol committed
563 564 565 566 567 568 569 570 571 572 573
        }

    if (c->lfe_channel) {
        int sample;
        int32_t m = 0;

        for (sample = 0; sample < DCA_LFE_SAMPLES; sample++)
            if (m < abs(c->downsampled_lfe[sample]))
                m = abs(c->downsampled_lfe[sample]);
        c->lfe_peak_cb = get_cb(m);
    }
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
574 575
}

Paul B Mahol's avatar
Paul B Mahol committed
576 577 578 579 580
static const int snr_fudge = 128;
#define USED_1ABITS 1
#define USED_NABITS 2
#define USED_26ABITS 4

581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677
static int32_t quantize_value(int32_t value, softfloat quant)
{
    int32_t offset = 1 << (quant.e - 1);

    value = mul32(value, quant.m) + offset;
    value = value >> quant.e;
    return value;
}

static int calc_one_scale(int32_t peak_cb, int abits, softfloat *quant)
{
    int32_t peak;
    int our_nscale, try_remove;
    softfloat our_quant;

    av_assert0(peak_cb <= 0);
    av_assert0(peak_cb >= -2047);

    our_nscale = 127;
    peak = cb_to_level[-peak_cb];

    for (try_remove = 64; try_remove > 0; try_remove >>= 1) {
        if (scalefactor_inv[our_nscale - try_remove].e + stepsize_inv[abits].e <= 17)
            continue;
        our_quant.m = mul32(scalefactor_inv[our_nscale - try_remove].m, stepsize_inv[abits].m);
        our_quant.e = scalefactor_inv[our_nscale - try_remove].e + stepsize_inv[abits].e - 17;
        if ((ff_dca_quant_levels[abits] - 1) / 2 < quantize_value(peak, our_quant))
            continue;
        our_nscale -= try_remove;
    }

    if (our_nscale >= 125)
        our_nscale = 124;

    quant->m = mul32(scalefactor_inv[our_nscale].m, stepsize_inv[abits].m);
    quant->e = scalefactor_inv[our_nscale].e + stepsize_inv[abits].e - 17;
    av_assert0((ff_dca_quant_levels[abits] - 1) / 2 >= quantize_value(peak, *quant));

    return our_nscale;
}

static void quantize_all(DCAEncContext *c)
{
    int sample, band, ch;

    for (ch = 0; ch < c->fullband_channels; ch++)
        for (band = 0; band < 32; band++)
            for (sample = 0; sample < SUBBAND_SAMPLES; sample++)
                c->quantized[ch][band][sample] = quantize_value(c->subband[ch][band][sample], c->quant[ch][band]);
}

static void accumulate_huff_bit_consumption(int abits, int32_t *quantized, uint32_t *result)
{
    uint8_t sel, id = abits - 1;
    for (sel = 0; sel < ff_dca_quant_index_group_size[id]; sel++)
        result[sel] += ff_dca_vlc_calc_quant_bits(quantized, SUBBAND_SAMPLES, sel, id);
}

static uint32_t set_best_code(uint32_t vlc_bits[DCA_CODE_BOOKS][7], uint32_t clc_bits[DCA_CODE_BOOKS], int32_t res[DCA_CODE_BOOKS])
{
    uint8_t i, sel;
    uint32_t best_sel_bits[DCA_CODE_BOOKS];
    int32_t best_sel_id[DCA_CODE_BOOKS];
    uint32_t t, bits = 0;

    for (i = 0; i < DCA_CODE_BOOKS; i++) {

        av_assert0(!((!!vlc_bits[i][0]) ^ (!!clc_bits[i])));
        if (vlc_bits[i][0] == 0) {
            /* do not transmit adjustment index for empty codebooks */
            res[i] = ff_dca_quant_index_group_size[i];
            /* and skip it */
            continue;
        }

        best_sel_bits[i] = vlc_bits[i][0];
        best_sel_id[i] = 0;
        for (sel = 0; sel < ff_dca_quant_index_group_size[i]; sel++) {
            if (best_sel_bits[i] > vlc_bits[i][sel] && vlc_bits[i][sel]) {
                best_sel_bits[i] = vlc_bits[i][sel];
                best_sel_id[i] = sel;
            }
        }

        /* 2 bits to transmit scale factor adjustment index */
        t = best_sel_bits[i] + 2;
        if (t < clc_bits[i]) {
            res[i] = best_sel_id[i];
            bits += t;
        } else {
            res[i] = ff_dca_quant_index_group_size[i];
            bits += clc_bits[i];
        }
    }
    return bits;
}

678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704
static uint32_t set_best_abits_code(int abits[DCAENC_SUBBANDS], int bands, int32_t *res)
{
    uint8_t i;
    uint32_t t;
    int32_t best_sel = 6;
    int32_t best_bits = bands * 5;

    /* Check do we have subband which cannot be encoded by Huffman tables */
    for (i = 0; i < bands; i++) {
        if (abits[i] > 12) {
            *res = best_sel;
            return best_bits;
        }
    }

    for (i = 0; i < DCA_BITALLOC_12_COUNT; i++) {
        t = ff_dca_vlc_calc_alloc_bits(abits, bands, i);
        if (t < best_bits) {
            best_bits = t;
            best_sel = i;
        }
    }

    *res = best_sel;
    return best_bits;
}

705
static int init_quantization_noise(DCAEncContext *c, int noise)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
706
{
Paul B Mahol's avatar
Paul B Mahol committed
707
    int ch, band, ret = 0;
708 709 710
    uint32_t huff_bit_count_accum[MAX_CHANNELS][DCA_CODE_BOOKS][7];
    uint32_t clc_bit_count_accum[MAX_CHANNELS][DCA_CODE_BOOKS];
    uint32_t bits_counter = 0;
Paul B Mahol's avatar
Paul B Mahol committed
711

712
    c->consumed_bits = 132 + 333 * c->fullband_channels;
Paul B Mahol's avatar
Paul B Mahol committed
713 714 715 716 717 718
    if (c->lfe_channel)
        c->consumed_bits += 72;

    /* attempt to guess the bit distribution based on the prevoius frame */
    for (ch = 0; ch < c->fullband_channels; ch++) {
        for (band = 0; band < 32; band++) {
719
            int snr_cb = c->peak_cb[ch][band] - c->band_masking_cb[band] - noise;
Paul B Mahol's avatar
Paul B Mahol committed
720 721

            if (snr_cb >= 1312) {
722
                c->abits[ch][band] = 26;
Paul B Mahol's avatar
Paul B Mahol committed
723 724
                ret |= USED_26ABITS;
            } else if (snr_cb >= 222) {
725
                c->abits[ch][band] = 8 + mul32(snr_cb - 222, 69000000);
Paul B Mahol's avatar
Paul B Mahol committed
726 727
                ret |= USED_NABITS;
            } else if (snr_cb >= 0) {
728
                c->abits[ch][band] = 2 + mul32(snr_cb, 106000000);
Paul B Mahol's avatar
Paul B Mahol committed
729 730
                ret |= USED_NABITS;
            } else {
731
                c->abits[ch][band] = 1;
Paul B Mahol's avatar
Paul B Mahol committed
732 733 734
                ret |= USED_1ABITS;
            }
        }
735
        c->consumed_bits += set_best_abits_code(c->abits[ch], 32, &c->bit_allocation_sel[ch]);
Paul B Mahol's avatar
Paul B Mahol committed
736
    }
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
737

738 739 740 741 742 743 744 745 746 747 748 749 750 751 752
    /* Recalc scale_factor each time to get bits consumption in case of Huffman coding.
       It is suboptimal solution */
    /* TODO: May be cache scaled values */
    for (ch = 0; ch < c->fullband_channels; ch++) {
        for (band = 0; band < 32; band++) {
            c->scale_factor[ch][band] = calc_one_scale(c->peak_cb[ch][band],
                                                       c->abits[ch][band],
                                                       &c->quant[ch][band]);
        }
    }
    quantize_all(c);

    memset(huff_bit_count_accum, 0, MAX_CHANNELS * DCA_CODE_BOOKS * 7 * sizeof(uint32_t));
    memset(clc_bit_count_accum, 0, MAX_CHANNELS * DCA_CODE_BOOKS * sizeof(uint32_t));
    for (ch = 0; ch < c->fullband_channels; ch++) {
753
        for (band = 0; band < 32; band++) {
754 755 756 757 758 759
            if (c->abits[ch][band] && c->abits[ch][band] <= DCA_CODE_BOOKS) {
                accumulate_huff_bit_consumption(c->abits[ch][band], c->quantized[ch][band], huff_bit_count_accum[ch][c->abits[ch][band] - 1]);
                clc_bit_count_accum[ch][c->abits[ch][band] - 1] += bit_consumption[c->abits[ch][band]];
            } else {
                bits_counter += bit_consumption[c->abits[ch][band]];
            }
Paul B Mahol's avatar
Paul B Mahol committed
760
        }
761 762 763 764 765 766 767
    }

    for (ch = 0; ch < c->fullband_channels; ch++) {
        bits_counter += set_best_code(huff_bit_count_accum[ch], clc_bit_count_accum[ch], c->quant_index_sel[ch]);
    }

    c->consumed_bits += bits_counter;
Paul B Mahol's avatar
Paul B Mahol committed
768 769 770 771

    return ret;
}

772
static void assign_bits(DCAEncContext *c)
Paul B Mahol's avatar
Paul B Mahol committed
773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809
{
    /* Find the bounds where the binary search should work */
    int low, high, down;
    int used_abits = 0;

    init_quantization_noise(c, c->worst_quantization_noise);
    low = high = c->worst_quantization_noise;
    if (c->consumed_bits > c->frame_bits) {
        while (c->consumed_bits > c->frame_bits) {
            av_assert0(used_abits != USED_1ABITS);
            low = high;
            high += snr_fudge;
            used_abits = init_quantization_noise(c, high);
        }
    } else {
        while (c->consumed_bits <= c->frame_bits) {
            high = low;
            if (used_abits == USED_26ABITS)
                goto out; /* The requested bitrate is too high, pad with zeros */
            low -= snr_fudge;
            used_abits = init_quantization_noise(c, low);
        }
    }

    /* Now do a binary search between low and high to see what fits */
    for (down = snr_fudge >> 1; down; down >>= 1) {
        init_quantization_noise(c, high - down);
        if (c->consumed_bits <= c->frame_bits)
            high -= down;
    }
    init_quantization_noise(c, high);
out:
    c->worst_quantization_noise = high;
    if (high > c->worst_noise_ever)
        c->worst_noise_ever = high;
}

810
static void shift_history(DCAEncContext *c, const int32_t *input)
Paul B Mahol's avatar
Paul B Mahol committed
811 812 813 814
{
    int k, ch;

    for (k = 0; k < 512; k++)
815 816 817
        for (ch = 0; ch < c->channels; ch++) {
            const int chi = c->channel_order_tab[ch];

818
            c->history[ch][k] = input[k * c->channels + chi];
819
        }
Paul B Mahol's avatar
Paul B Mahol committed
820 821
}

822
static void calc_lfe_scales(DCAEncContext *c)
Paul B Mahol's avatar
Paul B Mahol committed
823 824 825 826 827
{
    if (c->lfe_channel)
        c->lfe_scale_factor = calc_one_scale(c->lfe_peak_cb, 11, &c->lfe_quant);
}

828
static void put_frame_header(DCAEncContext *c)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
829 830 831 832 833 834 835 836 837 838 839 840 841 842 843
{
    /* SYNC */
    put_bits(&c->pb, 16, 0x7ffe);
    put_bits(&c->pb, 16, 0x8001);

    /* Frame type: normal */
    put_bits(&c->pb, 1, 1);

    /* Deficit sample count: none */
    put_bits(&c->pb, 5, 31);

    /* CRC is not present */
    put_bits(&c->pb, 1, 0);

    /* Number of PCM sample blocks */
Paul B Mahol's avatar
Paul B Mahol committed
844
    put_bits(&c->pb, 7, SUBBAND_SAMPLES - 1);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
845 846

    /* Primary frame byte size */
Paul B Mahol's avatar
Paul B Mahol committed
847
    put_bits(&c->pb, 14, c->frame_size - 1);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
848

Paul B Mahol's avatar
Paul B Mahol committed
849 850
    /* Audio channel arrangement */
    put_bits(&c->pb, 6, c->channel_config);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
851 852

    /* Core audio sampling frequency */
Paul B Mahol's avatar
Paul B Mahol committed
853
    put_bits(&c->pb, 4, bitstream_sfreq[c->samplerate_index]);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
854

Paul B Mahol's avatar
Paul B Mahol committed
855 856
    /* Transmission bit rate */
    put_bits(&c->pb, 5, c->bitrate_index);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881

    /* Embedded down mix: disabled */
    put_bits(&c->pb, 1, 0);

    /* Embedded dynamic range flag: not present */
    put_bits(&c->pb, 1, 0);

    /* Embedded time stamp flag: not present */
    put_bits(&c->pb, 1, 0);

    /* Auxiliary data flag: not present */
    put_bits(&c->pb, 1, 0);

    /* HDCD source: no */
    put_bits(&c->pb, 1, 0);

    /* Extension audio ID: N/A */
    put_bits(&c->pb, 3, 0);

    /* Extended audio data: not present */
    put_bits(&c->pb, 1, 0);

    /* Audio sync word insertion flag: after each sub-frame */
    put_bits(&c->pb, 1, 0);

Paul B Mahol's avatar
Paul B Mahol committed
882 883
    /* Low frequency effects flag: not present or 64x subsampling */
    put_bits(&c->pb, 2, c->lfe_channel ? 2 : 0);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910

    /* Predictor history switch flag: on */
    put_bits(&c->pb, 1, 1);

    /* No CRC */
    /* Multirate interpolator switch: non-perfect reconstruction */
    put_bits(&c->pb, 1, 0);

    /* Encoder software revision: 7 */
    put_bits(&c->pb, 4, 7);

    /* Copy history: 0 */
    put_bits(&c->pb, 2, 0);

    /* Source PCM resolution: 16 bits, not DTS ES */
    put_bits(&c->pb, 3, 0);

    /* Front sum/difference coding: no */
    put_bits(&c->pb, 1, 0);

    /* Surrounds sum/difference coding: no */
    put_bits(&c->pb, 1, 0);

    /* Dialog normalization: 0 dB */
    put_bits(&c->pb, 4, 0);
}

911
static void put_primary_audio_header(DCAEncContext *c)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
912 913 914 915 916 917
{
    int ch, i;
    /* Number of subframes */
    put_bits(&c->pb, 4, SUBFRAMES - 1);

    /* Number of primary audio channels */
Paul B Mahol's avatar
Paul B Mahol committed
918
    put_bits(&c->pb, 3, c->fullband_channels - 1);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
919 920

    /* Subband activity count */
Paul B Mahol's avatar
Paul B Mahol committed
921
    for (ch = 0; ch < c->fullband_channels; ch++)
922
        put_bits(&c->pb, 5, DCAENC_SUBBANDS - 2);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
923 924

    /* High frequency VQ start subband */
Paul B Mahol's avatar
Paul B Mahol committed
925
    for (ch = 0; ch < c->fullband_channels; ch++)
926
        put_bits(&c->pb, 5, DCAENC_SUBBANDS - 1);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
927 928

    /* Joint intensity coding index: 0, 0 */
Paul B Mahol's avatar
Paul B Mahol committed
929
    for (ch = 0; ch < c->fullband_channels; ch++)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
930 931 932
        put_bits(&c->pb, 3, 0);

    /* Transient mode codebook: A4, A4 (arbitrary) */
Paul B Mahol's avatar
Paul B Mahol committed
933
    for (ch = 0; ch < c->fullband_channels; ch++)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
934 935 936
        put_bits(&c->pb, 2, 0);

    /* Scale factor code book: 7 bit linear, 7-bit sqrt table (for each channel) */
Paul B Mahol's avatar
Paul B Mahol committed
937
    for (ch = 0; ch < c->fullband_channels; ch++)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
938 939 940
        put_bits(&c->pb, 3, 6);

    /* Bit allocation quantizer select: linear 5-bit */
Paul B Mahol's avatar
Paul B Mahol committed
941
    for (ch = 0; ch < c->fullband_channels; ch++)
942
        put_bits(&c->pb, 3, c->bit_allocation_sel[ch]);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
943

944 945
    /* Quantization index codebook select */
    for (i = 0; i < DCA_CODE_BOOKS; i++)
Paul B Mahol's avatar
Paul B Mahol committed
946
        for (ch = 0; ch < c->fullband_channels; ch++)
947 948 949 950 951 952 953
            put_bits(&c->pb, ff_dca_quant_index_sel_nbits[i], c->quant_index_sel[ch][i]);

    /* Scale factor adjustment index: transmitted in case of Huffman coding */
    for (i = 0; i < DCA_CODE_BOOKS; i++)
        for (ch = 0; ch < c->fullband_channels; ch++)
            if (c->quant_index_sel[ch][i] < ff_dca_quant_index_group_size[i])
                put_bits(&c->pb, 2, 0);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
954

Paul B Mahol's avatar
Paul B Mahol committed
955
    /* Audio header CRC check word: not transmitted */
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
956 957
}

958
static void put_subframe_samples(DCAEncContext *c, int ss, int band, int ch)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
959
{
960 961 962 963 964 965 966 967
    int i, j, sum, bits, sel;
    if (c->abits[ch][band] <= DCA_CODE_BOOKS) {
        av_assert0(c->abits[ch][band] > 0);
        sel = c->quant_index_sel[ch][c->abits[ch][band] - 1];
        // Huffman codes
        if (sel < ff_dca_quant_index_group_size[c->abits[ch][band] - 1]) {
            ff_dca_vlc_enc_quant(&c->pb, &c->quantized[ch][band][ss * 8], 8, sel, c->abits[ch][band] - 1);
            return;
Paul B Mahol's avatar
Paul B Mahol committed
968
        }
969 970 971 972 973 974 975 976 977 978 979 980 981

        // Block codes
        if (c->abits[ch][band] <= 7) {
            for (i = 0; i < 8; i += 4) {
                sum = 0;
                for (j = 3; j >= 0; j--) {
                    sum *= ff_dca_quant_levels[c->abits[ch][band]];
                    sum += c->quantized[ch][band][ss * 8 + i + j];
                    sum += (ff_dca_quant_levels[c->abits[ch][band]] - 1) / 2;
                }
                put_bits(&c->pb, bit_consumption[c->abits[ch][band]] / 4, sum);
            }
            return;
Paul B Mahol's avatar
Paul B Mahol committed
982
        }
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
983
    }
984 985 986 987 988

    for (i = 0; i < 8; i++) {
        bits = bit_consumption[c->abits[ch][band]] / 16;
        put_sbits(&c->pb, bits, c->quantized[ch][band][ss * 8 + i]);
    }
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
989 990
}

991
static void put_subframe(DCAEncContext *c, int subframe)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
992
{
Paul B Mahol's avatar
Paul B Mahol committed
993
    int i, band, ss, ch;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
994 995 996 997 998 999 1000 1001

    /* Subsubframes count */
    put_bits(&c->pb, 2, SUBSUBFRAMES -1);

    /* Partial subsubframe sample count: dummy */
    put_bits(&c->pb, 3, 0);

    /* Prediction mode: no ADPCM, in each channel and subband */
Paul B Mahol's avatar
Paul B Mahol committed
1002
    for (ch = 0; ch < c->fullband_channels; ch++)
1003
        for (band = 0; band < DCAENC_SUBBANDS; band++)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1004 1005
            put_bits(&c->pb, 1, 0);

Lou Logan's avatar
Lou Logan committed
1006
    /* Prediction VQ address: not transmitted */
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1007
    /* Bit allocation index */
1008 1009 1010 1011 1012 1013 1014 1015 1016
    for (ch = 0; ch < c->fullband_channels; ch++) {
        if (c->bit_allocation_sel[ch] == 6) {
            for (band = 0; band < DCAENC_SUBBANDS; band++) {
                put_bits(&c->pb, 5, c->abits[ch][band]);
            }
        } else {
            ff_dca_vlc_enc_alloc(&c->pb, c->abits[ch], DCAENC_SUBBANDS, c->bit_allocation_sel[ch]);
        }
    }
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1017 1018 1019

    if (SUBSUBFRAMES > 1) {
        /* Transition mode: none for each channel and subband */
Paul B Mahol's avatar
Paul B Mahol committed
1020
        for (ch = 0; ch < c->fullband_channels; ch++)
1021
            for (band = 0; band < DCAENC_SUBBANDS; band++)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1022 1023 1024
                put_bits(&c->pb, 1, 0); /* codebook A4 */
    }

Paul B Mahol's avatar
Paul B Mahol committed
1025 1026
    /* Scale factors */
    for (ch = 0; ch < c->fullband_channels; ch++)
1027
        for (band = 0; band < DCAENC_SUBBANDS; band++)
1028
            put_bits(&c->pb, 7, c->scale_factor[ch][band]);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1029 1030 1031 1032 1033 1034 1035 1036

    /* Joint subband scale factor codebook select: not transmitted */
    /* Scale factors for joint subband coding: not transmitted */
    /* Stereo down-mix coefficients: not transmitted */
    /* Dynamic range coefficient: not transmitted */
    /* Stde information CRC check word: not transmitted */
    /* VQ encoded high frequency subbands: not transmitted */

Paul B Mahol's avatar
Paul B Mahol committed
1037
    /* LFE data: 8 samples and scalefactor */
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1038
    if (c->lfe_channel) {
Paul B Mahol's avatar
Paul B Mahol committed
1039 1040
        for (i = 0; i < DCA_LFE_SAMPLES; i++)
            put_bits(&c->pb, 8, quantize_value(c->downsampled_lfe[i], c->lfe_quant) & 0xff);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1041 1042 1043 1044 1045
        put_bits(&c->pb, 8, c->lfe_scale_factor);
    }

    /* Audio data (subsubframes) */
    for (ss = 0; ss < SUBSUBFRAMES ; ss++)
Paul B Mahol's avatar
Paul B Mahol committed
1046
        for (ch = 0; ch < c->fullband_channels; ch++)
1047
            for (band = 0; band < DCAENC_SUBBANDS; band++)
Paul B Mahol's avatar
Paul B Mahol committed
1048
                    put_subframe_samples(c, ss, band, ch);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1049 1050 1051 1052 1053

    /* DSYNC */
    put_bits(&c->pb, 16, 0xffff);
}

1054 1055
static int encode_frame(AVCodecContext *avctx, AVPacket *avpkt,
                        const AVFrame *frame, int *got_packet_ptr)
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1056
{
1057
    DCAEncContext *c = avctx->priv_data;
Paul B Mahol's avatar
Paul B Mahol committed
1058 1059
    const int32_t *samples;
    int ret, i;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1060

1061
    if ((ret = ff_alloc_packet2(avctx, avpkt, c->frame_size, 0)) < 0)
1062 1063
        return ret;

Paul B Mahol's avatar
Paul B Mahol committed
1064
    samples = (const int32_t *)frame->data[0];
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1065

Paul B Mahol's avatar
Paul B Mahol committed
1066 1067 1068
    subband_transform(c, samples);
    if (c->lfe_channel)
        lfe_downsample(c, samples);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1069

Paul B Mahol's avatar
Paul B Mahol committed
1070 1071 1072
    calc_masking(c, samples);
    find_peaks(c);
    assign_bits(c);
1073
    calc_lfe_scales(c);
Paul B Mahol's avatar
Paul B Mahol committed
1074
    shift_history(c, samples);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1075

Paul B Mahol's avatar
Paul B Mahol committed
1076 1077 1078 1079 1080
    init_put_bits(&c->pb, avpkt->data, avpkt->size);
    put_frame_header(c);
    put_primary_audio_header(c);
    for (i = 0; i < SUBFRAMES; i++)
        put_subframe(c, i);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1081

1082 1083 1084 1085

    for (i = put_bits_count(&c->pb); i < 8*c->frame_size; i++)
        put_bits(&c->pb, 1, 0);

Paul B Mahol's avatar
Paul B Mahol committed
1086
    flush_put_bits(&c->pb);
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1087

Paul B Mahol's avatar
Paul B Mahol committed
1088 1089
    avpkt->pts      = frame->pts;
    avpkt->duration = ff_samples_to_time_base(avctx, frame->nb_samples);
1090
    avpkt->size     = put_bits_count(&c->pb) >> 3;
Paul B Mahol's avatar
Paul B Mahol committed
1091
    *got_packet_ptr = 1;
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1092 1093 1094
    return 0;
}

Paul B Mahol's avatar
Paul B Mahol committed
1095 1096 1097 1098 1099
static const AVCodecDefault defaults[] = {
    { "b",          "1411200" },
    { NULL },
};

Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1100
AVCodec ff_dca_encoder = {
Paul B Mahol's avatar
Paul B Mahol committed
1101
    .name                  = "dca",
1102
    .long_name             = NULL_IF_CONFIG_SMALL("DCA (DTS Coherent Acoustics)"),
Paul B Mahol's avatar
Paul B Mahol committed
1103 1104
    .type                  = AVMEDIA_TYPE_AUDIO,
    .id                    = AV_CODEC_ID_DTS,
1105
    .priv_data_size        = sizeof(DCAEncContext),
Paul B Mahol's avatar
Paul B Mahol committed
1106 1107
    .init                  = encode_init,
    .encode2               = encode_frame,
1108
    .capabilities          = AV_CODEC_CAP_EXPERIMENTAL,
Paul B Mahol's avatar
Paul B Mahol committed
1109 1110 1111 1112 1113 1114 1115 1116 1117 1118
    .sample_fmts           = (const enum AVSampleFormat[]){ AV_SAMPLE_FMT_S32,
                                                            AV_SAMPLE_FMT_NONE },
    .supported_samplerates = sample_rates,
    .channel_layouts       = (const uint64_t[]) { AV_CH_LAYOUT_MONO,
                                                  AV_CH_LAYOUT_STEREO,
                                                  AV_CH_LAYOUT_2_2,
                                                  AV_CH_LAYOUT_5POINT0,
                                                  AV_CH_LAYOUT_5POINT1,
                                                  0 },
    .defaults              = defaults,
Alexander E. Patrakov's avatar
Alexander E. Patrakov committed
1119
};