mlpdec.c 35.8 KB
Newer Older
Ramiro Polla's avatar
Ramiro Polla committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
/*
 * MLP decoder
 * Copyright (c) 2007-2008 Ian Caulfield
 *
 * 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
 */

/**
23
 * @file libavcodec/mlpdec.c
Ramiro Polla's avatar
Ramiro Polla committed
24 25 26
 * MLP decoder
 */

27 28
#include <stdint.h>

Ramiro Polla's avatar
Ramiro Polla committed
29 30 31 32 33 34
#include "avcodec.h"
#include "libavutil/intreadwrite.h"
#include "bitstream.h"
#include "libavutil/crc.h"
#include "parser.h"
#include "mlp_parser.h"
35
#include "mlp.h"
Ramiro Polla's avatar
Ramiro Polla committed
36

Diego Biurrun's avatar
Diego Biurrun committed
37
/** number of bits used for VLC lookup - longest Huffman code is 9 */
Ramiro Polla's avatar
Ramiro Polla committed
38 39 40 41 42
#define VLC_BITS            9


static const char* sample_message =
    "Please file a bug report following the instructions at "
43
    "http://ffmpeg.org/bugreports.html and include "
Ramiro Polla's avatar
Ramiro Polla committed
44 45 46
    "a sample of this file.";

typedef struct SubStream {
Diego Biurrun's avatar
Diego Biurrun committed
47
    //! Set if a valid restart header has been read. Otherwise the substream cannot be decoded.
Ramiro Polla's avatar
Ramiro Polla committed
48 49 50 51 52 53 54 55 56 57 58 59 60
    uint8_t     restart_seen;

    //@{
    /** restart header data */
    //! The type of noise to be used in the rematrix stage.
    uint16_t    noise_type;

    //! The index of the first channel coded in this substream.
    uint8_t     min_channel;
    //! The index of the last channel coded in this substream.
    uint8_t     max_channel;
    //! The number of channels input into the rematrix stage.
    uint8_t     max_matrix_channel;
61 62
    //! For each channel output by the matrix, the output channel to map it to
    uint8_t     ch_assign[MAX_CHANNELS];
Ramiro Polla's avatar
Ramiro Polla committed
63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80

    //! The left shift applied to random noise in 0x31ea substreams.
    uint8_t     noise_shift;
    //! The current seed value for the pseudorandom noise generator(s).
    uint32_t    noisegen_seed;

    //! Set if the substream contains extra info to check the size of VLC blocks.
    uint8_t     data_check_present;

    //! Bitmask of which parameter sets are conveyed in a decoding parameter block.
    uint8_t     param_presence_flags;
#define PARAM_BLOCKSIZE     (1 << 7)
#define PARAM_MATRIX        (1 << 6)
#define PARAM_OUTSHIFT      (1 << 5)
#define PARAM_QUANTSTEP     (1 << 4)
#define PARAM_FIR           (1 << 3)
#define PARAM_IIR           (1 << 2)
#define PARAM_HUFFOFFSET    (1 << 1)
81
#define PARAM_PRESENCE      (1 << 0)
Ramiro Polla's avatar
Ramiro Polla committed
82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100
    //@}

    //@{
    /** matrix data */

    //! Number of matrices to be applied.
    uint8_t     num_primitive_matrices;

    //! matrix output channel
    uint8_t     matrix_out_ch[MAX_MATRICES];

    //! Whether the LSBs of the matrix output are encoded in the bitstream.
    uint8_t     lsb_bypass[MAX_MATRICES];
    //! Matrix coefficients, stored as 2.14 fixed point.
    int32_t     matrix_coeff[MAX_MATRICES][MAX_CHANNELS+2];
    //! Left shift to apply to noise values in 0x31eb substreams.
    uint8_t     matrix_noise_shift[MAX_MATRICES];
    //@}

Diego Biurrun's avatar
Diego Biurrun committed
101
    //! Left shift to apply to Huffman-decoded residuals.
Ramiro Polla's avatar
Ramiro Polla committed
102 103
    uint8_t     quant_step_size[MAX_CHANNELS];

Diego Biurrun's avatar
Diego Biurrun committed
104
    //! number of PCM samples in current audio block
Ramiro Polla's avatar
Ramiro Polla committed
105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128
    uint16_t    blocksize;
    //! Number of PCM samples decoded so far in this frame.
    uint16_t    blockpos;

    //! Left shift to apply to decoded PCM values to get final 24-bit output.
    int8_t      output_shift[MAX_CHANNELS];

    //! Running XOR of all output samples.
    int32_t     lossless_check_data;

} SubStream;

typedef struct MLPDecodeContext {
    AVCodecContext *avctx;

    //! Set if a valid major sync block has been read. Otherwise no decoding is possible.
    uint8_t     params_valid;

    //! Number of substreams contained within this stream.
    uint8_t     num_substreams;

    //! Index of the last substream to decode - further substreams are skipped.
    uint8_t     max_decoded_substream;

Diego Biurrun's avatar
Diego Biurrun committed
129
    //! number of PCM samples contained in each frame
Ramiro Polla's avatar
Ramiro Polla committed
130
    int         access_unit_size;
Diego Biurrun's avatar
Diego Biurrun committed
131
    //! next power of two above the number of samples in each frame
Ramiro Polla's avatar
Ramiro Polla committed
132 133 134 135
    int         access_unit_size_pow2;

    SubStream   substream[MAX_SUBSTREAMS];

136
    ChannelParams channel_params[MAX_CHANNELS];
Ramiro Polla's avatar
Ramiro Polla committed
137 138 139 140 141 142 143 144 145 146

    int8_t      noise_buffer[MAX_BLOCKSIZE_POW2];
    int8_t      bypassed_lsbs[MAX_BLOCKSIZE][MAX_CHANNELS];
    int32_t     sample_buffer[MAX_BLOCKSIZE][MAX_CHANNELS+2];
} MLPDecodeContext;

static VLC huff_vlc[3];

/** Initialize static data, constant between all invocations of the codec. */

147
static av_cold void init_static(void)
Ramiro Polla's avatar
Ramiro Polla committed
148 149
{
    INIT_VLC_STATIC(&huff_vlc[0], VLC_BITS, 18,
150 151
                &ff_mlp_huffman_tables[0][0][1], 2, 1,
                &ff_mlp_huffman_tables[0][0][0], 2, 1, 512);
Ramiro Polla's avatar
Ramiro Polla committed
152
    INIT_VLC_STATIC(&huff_vlc[1], VLC_BITS, 16,
153 154
                &ff_mlp_huffman_tables[1][0][1], 2, 1,
                &ff_mlp_huffman_tables[1][0][0], 2, 1, 512);
Ramiro Polla's avatar
Ramiro Polla committed
155
    INIT_VLC_STATIC(&huff_vlc[2], VLC_BITS, 15,
156 157
                &ff_mlp_huffman_tables[2][0][1], 2, 1,
                &ff_mlp_huffman_tables[2][0][0], 2, 1, 512);
Ramiro Polla's avatar
Ramiro Polla committed
158

159
    ff_mlp_init_crc();
Ramiro Polla's avatar
Ramiro Polla committed
160 161 162 163 164
}

static inline int32_t calculate_sign_huff(MLPDecodeContext *m,
                                          unsigned int substr, unsigned int ch)
{
165
    ChannelParams *cp = &m->channel_params[ch];
Ramiro Polla's avatar
Ramiro Polla committed
166
    SubStream *s = &m->substream[substr];
167 168 169
    int lsb_bits = cp->huff_lsbs - s->quant_step_size[ch];
    int sign_shift = lsb_bits + (cp->codebook ? 2 - cp->codebook : -1);
    int32_t sign_huff_offset = cp->huff_offset;
Ramiro Polla's avatar
Ramiro Polla committed
170

171
    if (cp->codebook > 0)
Ramiro Polla's avatar
Ramiro Polla committed
172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193
        sign_huff_offset -= 7 << lsb_bits;

    if (sign_shift >= 0)
        sign_huff_offset -= 1 << sign_shift;

    return sign_huff_offset;
}

/** Read a sample, consisting of either, both or neither of entropy-coded MSBs
 *  and plain LSBs. */

static inline int read_huff_channels(MLPDecodeContext *m, GetBitContext *gbp,
                                     unsigned int substr, unsigned int pos)
{
    SubStream *s = &m->substream[substr];
    unsigned int mat, channel;

    for (mat = 0; mat < s->num_primitive_matrices; mat++)
        if (s->lsb_bypass[mat])
            m->bypassed_lsbs[pos + s->blockpos][mat] = get_bits1(gbp);

    for (channel = s->min_channel; channel <= s->max_channel; channel++) {
194 195
        ChannelParams *cp = &m->channel_params[channel];
        int codebook = cp->codebook;
Ramiro Polla's avatar
Ramiro Polla committed
196
        int quant_step_size = s->quant_step_size[channel];
197
        int lsb_bits = cp->huff_lsbs - quant_step_size;
Ramiro Polla's avatar
Ramiro Polla committed
198 199 200 201 202 203 204 205 206 207 208 209
        int result = 0;

        if (codebook > 0)
            result = get_vlc2(gbp, huff_vlc[codebook-1].table,
                            VLC_BITS, (9 + VLC_BITS - 1) / VLC_BITS);

        if (result < 0)
            return -1;

        if (lsb_bits > 0)
            result = (result << lsb_bits) + get_bits(gbp, lsb_bits);

210
        result  += cp->sign_huff_offset;
Ramiro Polla's avatar
Ramiro Polla committed
211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227
        result <<= quant_step_size;

        m->sample_buffer[pos + s->blockpos][channel] = result;
    }

    return 0;
}

static av_cold int mlp_decode_init(AVCodecContext *avctx)
{
    MLPDecodeContext *m = avctx->priv_data;
    int substr;

    init_static();
    m->avctx = avctx;
    for (substr = 0; substr < MAX_SUBSTREAMS; substr++)
        m->substream[substr].lossless_check_data = 0xffffffff;
228

Ramiro Polla's avatar
Ramiro Polla committed
229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245
    return 0;
}

/** Read a major sync info header - contains high level information about
 *  the stream - sample rate, channel arrangement etc. Most of this
 *  information is not actually necessary for decoding, only for playback.
 */

static int read_major_sync(MLPDecodeContext *m, GetBitContext *gb)
{
    MLPHeaderInfo mh;
    int substr;

    if (ff_mlp_read_major_sync(m->avctx, &mh, gb) != 0)
        return -1;

    if (mh.group1_bits == 0) {
Diego Biurrun's avatar
Diego Biurrun committed
246
        av_log(m->avctx, AV_LOG_ERROR, "invalid/unknown bits per sample\n");
Ramiro Polla's avatar
Ramiro Polla committed
247 248 249 250
        return -1;
    }
    if (mh.group2_bits > mh.group1_bits) {
        av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
251
               "Channel group 2 cannot have more bits per sample than group 1.\n");
Ramiro Polla's avatar
Ramiro Polla committed
252 253 254 255 256
        return -1;
    }

    if (mh.group2_samplerate && mh.group2_samplerate != mh.group1_samplerate) {
        av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
257
               "Channel groups with differing sample rates are not currently supported.\n");
Ramiro Polla's avatar
Ramiro Polla committed
258 259 260 261
        return -1;
    }

    if (mh.group1_samplerate == 0) {
Diego Biurrun's avatar
Diego Biurrun committed
262
        av_log(m->avctx, AV_LOG_ERROR, "invalid/unknown sampling rate\n");
Ramiro Polla's avatar
Ramiro Polla committed
263 264 265 266
        return -1;
    }
    if (mh.group1_samplerate > MAX_SAMPLERATE) {
        av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
267
               "Sampling rate %d is greater than the supported maximum (%d).\n",
Ramiro Polla's avatar
Ramiro Polla committed
268 269 270 271 272
               mh.group1_samplerate, MAX_SAMPLERATE);
        return -1;
    }
    if (mh.access_unit_size > MAX_BLOCKSIZE) {
        av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
273
               "Block size %d is greater than the supported maximum (%d).\n",
Ramiro Polla's avatar
Ramiro Polla committed
274 275 276 277 278
               mh.access_unit_size, MAX_BLOCKSIZE);
        return -1;
    }
    if (mh.access_unit_size_pow2 > MAX_BLOCKSIZE_POW2) {
        av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
279
               "Block size pow2 %d is greater than the supported maximum (%d).\n",
Ramiro Polla's avatar
Ramiro Polla committed
280 281 282 283 284 285
               mh.access_unit_size_pow2, MAX_BLOCKSIZE_POW2);
        return -1;
    }

    if (mh.num_substreams == 0)
        return -1;
286 287 288 289
    if (m->avctx->codec_id == CODEC_ID_MLP && mh.num_substreams > 2) {
        av_log(m->avctx, AV_LOG_ERROR, "MLP only supports up to 2 substreams.\n");
        return -1;
    }
Ramiro Polla's avatar
Ramiro Polla committed
290 291
    if (mh.num_substreams > MAX_SUBSTREAMS) {
        av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
292 293
               "Number of substreams %d is larger than the maximum supported "
               "by the decoder. %s\n", mh.num_substreams, sample_message);
Ramiro Polla's avatar
Ramiro Polla committed
294 295 296 297 298 299 300 301 302 303 304 305
        return -1;
    }

    m->access_unit_size      = mh.access_unit_size;
    m->access_unit_size_pow2 = mh.access_unit_size_pow2;

    m->num_substreams        = mh.num_substreams;
    m->max_decoded_substream = m->num_substreams - 1;

    m->avctx->sample_rate    = mh.group1_samplerate;
    m->avctx->frame_size     = mh.access_unit_size;

306
    m->avctx->bits_per_raw_sample = mh.group1_bits;
307
    if (mh.group1_bits > 16)
Ramiro Polla's avatar
Ramiro Polla committed
308
        m->avctx->sample_fmt = SAMPLE_FMT_S32;
309 310
    else
        m->avctx->sample_fmt = SAMPLE_FMT_S16;
Ramiro Polla's avatar
Ramiro Polla committed
311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336

    m->params_valid = 1;
    for (substr = 0; substr < MAX_SUBSTREAMS; substr++)
        m->substream[substr].restart_seen = 0;

    return 0;
}

/** Read a restart header from a block in a substream. This contains parameters
 *  required to decode the audio that do not change very often. Generally
 *  (always) present only in blocks following a major sync. */

static int read_restart_header(MLPDecodeContext *m, GetBitContext *gbp,
                               const uint8_t *buf, unsigned int substr)
{
    SubStream *s = &m->substream[substr];
    unsigned int ch;
    int sync_word, tmp;
    uint8_t checksum;
    uint8_t lossless_check;
    int start_count = get_bits_count(gbp);

    sync_word = get_bits(gbp, 13);

    if (sync_word != 0x31ea >> 1) {
        av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
337
               "restart header sync incorrect (got 0x%04x)\n", sync_word);
Ramiro Polla's avatar
Ramiro Polla committed
338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372
        return -1;
    }
    s->noise_type = get_bits1(gbp);

    skip_bits(gbp, 16); /* Output timestamp */

    s->min_channel        = get_bits(gbp, 4);
    s->max_channel        = get_bits(gbp, 4);
    s->max_matrix_channel = get_bits(gbp, 4);

    if (s->min_channel > s->max_channel) {
        av_log(m->avctx, AV_LOG_ERROR,
               "Substream min channel cannot be greater than max channel.\n");
        return -1;
    }

    if (m->avctx->request_channels > 0
        && s->max_channel + 1 >= m->avctx->request_channels
        && substr < m->max_decoded_substream) {
        av_log(m->avctx, AV_LOG_INFO,
               "Extracting %d channel downmix from substream %d. "
               "Further substreams will be skipped.\n",
               s->max_channel + 1, substr);
        m->max_decoded_substream = substr;
    }

    s->noise_shift   = get_bits(gbp,  4);
    s->noisegen_seed = get_bits(gbp, 23);

    skip_bits(gbp, 19);

    s->data_check_present = get_bits1(gbp);
    lossless_check = get_bits(gbp, 8);
    if (substr == m->max_decoded_substream
        && s->lossless_check_data != 0xffffffff) {
373
        tmp = xor_32_to_8(s->lossless_check_data);
Ramiro Polla's avatar
Ramiro Polla committed
374 375
        if (tmp != lossless_check)
            av_log(m->avctx, AV_LOG_WARNING,
Diego Biurrun's avatar
Diego Biurrun committed
376
                   "Lossless check failed - expected %02x, calculated %02x.\n",
Ramiro Polla's avatar
Ramiro Polla committed
377 378
                   lossless_check, tmp);
        else
Diego Biurrun's avatar
Diego Biurrun committed
379
            dprintf(m->avctx, "Lossless check passed for substream %d (%x).\n",
Ramiro Polla's avatar
Ramiro Polla committed
380 381 382 383 384
                    substr, tmp);
    }

    skip_bits(gbp, 16);

385 386
    memset(s->ch_assign, 0, sizeof(s->ch_assign));

Ramiro Polla's avatar
Ramiro Polla committed
387 388 389 390
    for (ch = 0; ch <= s->max_matrix_channel; ch++) {
        int ch_assign = get_bits(gbp, 6);
        dprintf(m->avctx, "ch_assign[%d][%d] = %d\n", substr, ch,
                ch_assign);
391
        if (ch_assign > s->max_matrix_channel) {
Ramiro Polla's avatar
Ramiro Polla committed
392
            av_log(m->avctx, AV_LOG_ERROR,
393 394
                   "Assignment of matrix channel %d to invalid output channel %d. %s\n",
                   ch, ch_assign, sample_message);
Ramiro Polla's avatar
Ramiro Polla committed
395 396
            return -1;
        }
397
        s->ch_assign[ch_assign] = ch;
Ramiro Polla's avatar
Ramiro Polla committed
398 399
    }

400
    checksum = ff_mlp_restart_checksum(buf, get_bits_count(gbp) - start_count);
Ramiro Polla's avatar
Ramiro Polla committed
401 402

    if (checksum != get_bits(gbp, 8))
Diego Biurrun's avatar
Diego Biurrun committed
403
        av_log(m->avctx, AV_LOG_ERROR, "restart header checksum error\n");
Ramiro Polla's avatar
Ramiro Polla committed
404

Diego Biurrun's avatar
Diego Biurrun committed
405
    /* Set default decoding parameters. */
Ramiro Polla's avatar
Ramiro Polla committed
406 407 408 409 410 411 412 413 414
    s->param_presence_flags   = 0xff;
    s->num_primitive_matrices = 0;
    s->blocksize              = 8;
    s->lossless_check_data    = 0;

    memset(s->output_shift   , 0, sizeof(s->output_shift   ));
    memset(s->quant_step_size, 0, sizeof(s->quant_step_size));

    for (ch = s->min_channel; ch <= s->max_channel; ch++) {
415 416 417 418 419
        ChannelParams *cp = &m->channel_params[ch];
        cp->filter_params[FIR].order = 0;
        cp->filter_params[IIR].order = 0;
        cp->filter_params[FIR].shift = 0;
        cp->filter_params[IIR].shift = 0;
Ramiro Polla's avatar
Ramiro Polla committed
420

Diego Biurrun's avatar
Diego Biurrun committed
421
        /* Default audio coding is 24-bit raw PCM. */
422 423 424 425
        cp->huff_offset      = 0;
        cp->sign_huff_offset = (-1) << 23;
        cp->codebook         = 0;
        cp->huff_lsbs        = 24;
Ramiro Polla's avatar
Ramiro Polla committed
426 427 428
    }

    if (substr == m->max_decoded_substream) {
429
        m->avctx->channels = s->max_matrix_channel + 1;
Ramiro Polla's avatar
Ramiro Polla committed
430 431 432 433 434 435 436 437 438 439
    }

    return 0;
}

/** Read parameters for one of the prediction filters. */

static int read_filter_params(MLPDecodeContext *m, GetBitContext *gbp,
                              unsigned int channel, unsigned int filter)
{
440
    FilterParams *fp = &m->channel_params[channel].filter_params[filter];
Ramiro Polla's avatar
Ramiro Polla committed
441 442 443
    const char fchar = filter ? 'I' : 'F';
    int i, order;

Diego Biurrun's avatar
Diego Biurrun committed
444
    // Filter is 0 for FIR, 1 for IIR.
Ramiro Polla's avatar
Ramiro Polla committed
445 446 447 448 449
    assert(filter < 2);

    order = get_bits(gbp, 4);
    if (order > MAX_FILTER_ORDER) {
        av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
450
               "%cIR filter order %d is greater than maximum %d.\n",
Ramiro Polla's avatar
Ramiro Polla committed
451 452 453
               fchar, order, MAX_FILTER_ORDER);
        return -1;
    }
454
    fp->order = order;
Ramiro Polla's avatar
Ramiro Polla committed
455 456 457 458

    if (order > 0) {
        int coeff_bits, coeff_shift;

459
        fp->shift = get_bits(gbp, 4);
Ramiro Polla's avatar
Ramiro Polla committed
460 461 462 463 464

        coeff_bits  = get_bits(gbp, 5);
        coeff_shift = get_bits(gbp, 3);
        if (coeff_bits < 1 || coeff_bits > 16) {
            av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
465
                   "%cIR filter coeff_bits must be between 1 and 16.\n",
Ramiro Polla's avatar
Ramiro Polla committed
466 467 468 469 470
                   fchar);
            return -1;
        }
        if (coeff_bits + coeff_shift > 16) {
            av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
471
                   "Sum of coeff_bits and coeff_shift for %cIR filter must be 16 or less.\n",
Ramiro Polla's avatar
Ramiro Polla committed
472 473 474 475 476
                   fchar);
            return -1;
        }

        for (i = 0; i < order; i++)
477
            fp->coeff[i] = get_sbits(gbp, coeff_bits) << coeff_shift;
Ramiro Polla's avatar
Ramiro Polla committed
478 479 480 481 482 483

        if (get_bits1(gbp)) {
            int state_bits, state_shift;

            if (filter == FIR) {
                av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
484
                       "FIR filter has state data specified.\n");
Ramiro Polla's avatar
Ramiro Polla committed
485 486 487 488 489 490
                return -1;
            }

            state_bits  = get_bits(gbp, 4);
            state_shift = get_bits(gbp, 4);

Diego Biurrun's avatar
Diego Biurrun committed
491
            /* TODO: Check validity of state data. */
Ramiro Polla's avatar
Ramiro Polla committed
492 493

            for (i = 0; i < order; i++)
494
                fp->state[i] = get_sbits(gbp, state_bits) << state_shift;
Ramiro Polla's avatar
Ramiro Polla committed
495 496 497 498 499 500
        }
    }

    return 0;
}

501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547
/** Read parameters for primitive matrices. */

static int read_matrix_params(MLPDecodeContext *m, SubStream *s, GetBitContext *gbp)
{
    unsigned int mat, ch;

    s->num_primitive_matrices = get_bits(gbp, 4);

    for (mat = 0; mat < s->num_primitive_matrices; mat++) {
        int frac_bits, max_chan;
        s->matrix_out_ch[mat] = get_bits(gbp, 4);
        frac_bits             = get_bits(gbp, 4);
        s->lsb_bypass   [mat] = get_bits1(gbp);

        if (s->matrix_out_ch[mat] > s->max_channel) {
            av_log(m->avctx, AV_LOG_ERROR,
                    "Invalid channel %d specified as output from matrix.\n",
                    s->matrix_out_ch[mat]);
            return -1;
        }
        if (frac_bits > 14) {
            av_log(m->avctx, AV_LOG_ERROR,
                    "Too many fractional bits specified.\n");
            return -1;
        }

        max_chan = s->max_matrix_channel;
        if (!s->noise_type)
            max_chan+=2;

        for (ch = 0; ch <= max_chan; ch++) {
            int coeff_val = 0;
            if (get_bits1(gbp))
                coeff_val = get_sbits(gbp, frac_bits + 2);

            s->matrix_coeff[mat][ch] = coeff_val << (14 - frac_bits);
        }

        if (s->noise_type)
            s->matrix_noise_shift[mat] = get_bits(gbp, 4);
        else
            s->matrix_noise_shift[mat] = 0;
    }

    return 0;
}

548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595
/** Read channel parameters. */

static int read_channel_params(MLPDecodeContext *m, unsigned int substr,
                               GetBitContext *gbp, unsigned int ch)
{
    ChannelParams *cp = &m->channel_params[ch];
    FilterParams *fir = &cp->filter_params[FIR];
    FilterParams *iir = &cp->filter_params[IIR];
    SubStream *s = &m->substream[substr];

    if (s->param_presence_flags & PARAM_FIR)
        if (get_bits1(gbp))
            if (read_filter_params(m, gbp, ch, FIR) < 0)
                return -1;

    if (s->param_presence_flags & PARAM_IIR)
        if (get_bits1(gbp))
            if (read_filter_params(m, gbp, ch, IIR) < 0)
                return -1;

    if (fir->order && iir->order &&
        fir->shift != iir->shift) {
        av_log(m->avctx, AV_LOG_ERROR,
                "FIR and IIR filters must use the same precision.\n");
        return -1;
    }
    /* The FIR and IIR filters must have the same precision.
        * To simplify the filtering code, only the precision of the
        * FIR filter is considered. If only the IIR filter is employed,
        * the FIR filter precision is set to that of the IIR filter, so
        * that the filtering code can use it. */
    if (!fir->order && iir->order)
        fir->shift = iir->shift;

    if (s->param_presence_flags & PARAM_HUFFOFFSET)
        if (get_bits1(gbp))
            cp->huff_offset = get_sbits(gbp, 15);

    cp->codebook  = get_bits(gbp, 2);
    cp->huff_lsbs = get_bits(gbp, 5);

    cp->sign_huff_offset = calculate_sign_huff(m, substr, ch);

    /* TODO: validate */

    return 0;
}

Ramiro Polla's avatar
Ramiro Polla committed
596 597 598 599 600 601 602
/** Read decoding parameters that change more often than those in the restart
 *  header. */

static int read_decoding_params(MLPDecodeContext *m, GetBitContext *gbp,
                                unsigned int substr)
{
    SubStream *s = &m->substream[substr];
603
    unsigned int ch;
Ramiro Polla's avatar
Ramiro Polla committed
604

605
    if (s->param_presence_flags & PARAM_PRESENCE)
Ramiro Polla's avatar
Ramiro Polla committed
606 607 608 609 610 611 612
    if (get_bits1(gbp))
        s->param_presence_flags = get_bits(gbp, 8);

    if (s->param_presence_flags & PARAM_BLOCKSIZE)
        if (get_bits1(gbp)) {
            s->blocksize = get_bits(gbp, 9);
            if (s->blocksize > MAX_BLOCKSIZE) {
Diego Biurrun's avatar
Diego Biurrun committed
613
                av_log(m->avctx, AV_LOG_ERROR, "block size too large\n");
Ramiro Polla's avatar
Ramiro Polla committed
614 615 616 617 618 619 620
                s->blocksize = 0;
                return -1;
            }
        }

    if (s->param_presence_flags & PARAM_MATRIX)
        if (get_bits1(gbp)) {
621 622
            if (read_matrix_params(m, s, gbp) < 0)
                return -1;
Ramiro Polla's avatar
Ramiro Polla committed
623 624 625 626 627
        }

    if (s->param_presence_flags & PARAM_OUTSHIFT)
        if (get_bits1(gbp))
            for (ch = 0; ch <= s->max_matrix_channel; ch++) {
Ramiro Polla's avatar
Ramiro Polla committed
628
                s->output_shift[ch] = get_sbits(gbp, 4);
Ramiro Polla's avatar
Ramiro Polla committed
629 630 631 632 633 634 635
                dprintf(m->avctx, "output shift[%d] = %d\n",
                        ch, s->output_shift[ch]);
            }

    if (s->param_presence_flags & PARAM_QUANTSTEP)
        if (get_bits1(gbp))
            for (ch = 0; ch <= s->max_channel; ch++) {
636 637
                ChannelParams *cp = &m->channel_params[ch];

Ramiro Polla's avatar
Ramiro Polla committed
638 639
                s->quant_step_size[ch] = get_bits(gbp, 4);

640
                cp->sign_huff_offset = calculate_sign_huff(m, substr, ch);
Ramiro Polla's avatar
Ramiro Polla committed
641 642 643 644
            }

    for (ch = s->min_channel; ch <= s->max_channel; ch++)
        if (get_bits1(gbp)) {
645
            if (read_channel_params(m, substr, gbp, ch) < 0)
Ramiro Polla's avatar
Ramiro Polla committed
646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661
                return -1;
        }

    return 0;
}

#define MSB_MASK(bits)  (-1u << bits)

/** Generate PCM samples using the prediction filters and residual values
 *  read from the data stream, and update the filter state. */

static void filter_channel(MLPDecodeContext *m, unsigned int substr,
                           unsigned int channel)
{
    SubStream *s = &m->substream[substr];
    int32_t filter_state_buffer[NUM_FILTERS][MAX_BLOCKSIZE + MAX_FILTER_ORDER];
662 663
    FilterParams *fp[NUM_FILTERS] = { &m->channel_params[channel].filter_params[FIR],
                                      &m->channel_params[channel].filter_params[IIR], };
664
    unsigned int filter_shift = fp[FIR]->shift;
Ramiro Polla's avatar
Ramiro Polla committed
665 666 667 668 669
    int32_t mask = MSB_MASK(s->quant_step_size[channel]);
    int index = MAX_BLOCKSIZE;
    int j, i;

    for (j = 0; j < NUM_FILTERS; j++) {
670
        memcpy(&filter_state_buffer[j][MAX_BLOCKSIZE], &fp[j]->state[0],
Ramiro Polla's avatar
Ramiro Polla committed
671 672 673 674 675 676 677 678 679 680 681 682
               MAX_FILTER_ORDER * sizeof(int32_t));
    }

    for (i = 0; i < s->blocksize; i++) {
        int32_t residual = m->sample_buffer[i + s->blockpos][channel];
        unsigned int order;
        int64_t accum = 0;
        int32_t result;

        /* TODO: Move this code to DSPContext? */

        for (j = 0; j < NUM_FILTERS; j++)
683
            for (order = 0; order < fp[j]->order; order++)
Ramiro Polla's avatar
Ramiro Polla committed
684
                accum += (int64_t)filter_state_buffer[j][index + order] *
685
                                  fp[j]->coeff[order];
Ramiro Polla's avatar
Ramiro Polla committed
686 687 688 689 690 691 692 693 694 695 696 697 698

        accum  = accum >> filter_shift;
        result = (accum + residual) & mask;

        --index;

        filter_state_buffer[FIR][index] = result;
        filter_state_buffer[IIR][index] = result - accum;

        m->sample_buffer[i + s->blockpos][channel] = result;
    }

    for (j = 0; j < NUM_FILTERS; j++) {
699
        memcpy(&fp[j]->state[0], &filter_state_buffer[j][index],
Ramiro Polla's avatar
Ramiro Polla committed
700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719
               MAX_FILTER_ORDER * sizeof(int32_t));
    }
}

/** Read a block of PCM residual data (or actual if no filtering active). */

static int read_block_data(MLPDecodeContext *m, GetBitContext *gbp,
                           unsigned int substr)
{
    SubStream *s = &m->substream[substr];
    unsigned int i, ch, expected_stream_pos = 0;

    if (s->data_check_present) {
        expected_stream_pos  = get_bits_count(gbp);
        expected_stream_pos += get_bits(gbp, 16);
        av_log(m->avctx, AV_LOG_WARNING, "This file contains some features "
               "we have not tested yet. %s\n", sample_message);
    }

    if (s->blockpos + s->blocksize > m->access_unit_size) {
Diego Biurrun's avatar
Diego Biurrun committed
720
        av_log(m->avctx, AV_LOG_ERROR, "too many audio samples in frame\n");
Ramiro Polla's avatar
Ramiro Polla committed
721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739
        return -1;
    }

    memset(&m->bypassed_lsbs[s->blockpos][0], 0,
           s->blocksize * sizeof(m->bypassed_lsbs[0]));

    for (i = 0; i < s->blocksize; i++) {
        if (read_huff_channels(m, gbp, substr, i) < 0)
            return -1;
    }

    for (ch = s->min_channel; ch <= s->max_channel; ch++) {
        filter_channel(m, substr, ch);
    }

    s->blockpos += s->blocksize;

    if (s->data_check_present) {
        if (get_bits_count(gbp) != expected_stream_pos)
Diego Biurrun's avatar
Diego Biurrun committed
740
            av_log(m->avctx, AV_LOG_ERROR, "block data length mismatch\n");
Ramiro Polla's avatar
Ramiro Polla committed
741 742 743 744 745 746
        skip_bits(gbp, 8);
    }

    return 0;
}

Diego Biurrun's avatar
Diego Biurrun committed
747
/** Data table used for TrueHD noise generation function. */
Ramiro Polla's avatar
Ramiro Polla committed
748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 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 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860

static const int8_t noise_table[256] = {
     30,  51,  22,  54,   3,   7,  -4,  38,  14,  55,  46,  81,  22,  58,  -3,   2,
     52,  31,  -7,  51,  15,  44,  74,  30,  85, -17,  10,  33,  18,  80,  28,  62,
     10,  32,  23,  69,  72,  26,  35,  17,  73,  60,   8,  56,   2,   6,  -2,  -5,
     51,   4,  11,  50,  66,  76,  21,  44,  33,  47,   1,  26,  64,  48,  57,  40,
     38,  16, -10, -28,  92,  22, -18,  29, -10,   5, -13,  49,  19,  24,  70,  34,
     61,  48,  30,  14,  -6,  25,  58,  33,  42,  60,  67,  17,  54,  17,  22,  30,
     67,  44,  -9,  50, -11,  43,  40,  32,  59,  82,  13,  49, -14,  55,  60,  36,
     48,  49,  31,  47,  15,  12,   4,  65,   1,  23,  29,  39,  45,  -2,  84,  69,
      0,  72,  37,  57,  27,  41, -15, -16,  35,  31,  14,  61,  24,   0,  27,  24,
     16,  41,  55,  34,  53,   9,  56,  12,  25,  29,  53,   5,  20, -20,  -8,  20,
     13,  28,  -3,  78,  38,  16,  11,  62,  46,  29,  21,  24,  46,  65,  43, -23,
     89,  18,  74,  21,  38, -12,  19,  12, -19,   8,  15,  33,   4,  57,   9,  -8,
     36,  35,  26,  28,   7,  83,  63,  79,  75,  11,   3,  87,  37,  47,  34,  40,
     39,  19,  20,  42,  27,  34,  39,  77,  13,  42,  59,  64,  45,  -1,  32,  37,
     45,  -5,  53,  -6,   7,  36,  50,  23,   6,  32,   9, -21,  18,  71,  27,  52,
    -25,  31,  35,  42,  -1,  68,  63,  52,  26,  43,  66,  37,  41,  25,  40,  70,
};

/** Noise generation functions.
 *  I'm not sure what these are for - they seem to be some kind of pseudorandom
 *  sequence generators, used to generate noise data which is used when the
 *  channels are rematrixed. I'm not sure if they provide a practical benefit
 *  to compression, or just obfuscate the decoder. Are they for some kind of
 *  dithering? */

/** Generate two channels of noise, used in the matrix when
 *  restart sync word == 0x31ea. */

static void generate_2_noise_channels(MLPDecodeContext *m, unsigned int substr)
{
    SubStream *s = &m->substream[substr];
    unsigned int i;
    uint32_t seed = s->noisegen_seed;
    unsigned int maxchan = s->max_matrix_channel;

    for (i = 0; i < s->blockpos; i++) {
        uint16_t seed_shr7 = seed >> 7;
        m->sample_buffer[i][maxchan+1] = ((int8_t)(seed >> 15)) << s->noise_shift;
        m->sample_buffer[i][maxchan+2] = ((int8_t) seed_shr7)   << s->noise_shift;

        seed = (seed << 16) ^ seed_shr7 ^ (seed_shr7 << 5);
    }

    s->noisegen_seed = seed;
}

/** Generate a block of noise, used when restart sync word == 0x31eb. */

static void fill_noise_buffer(MLPDecodeContext *m, unsigned int substr)
{
    SubStream *s = &m->substream[substr];
    unsigned int i;
    uint32_t seed = s->noisegen_seed;

    for (i = 0; i < m->access_unit_size_pow2; i++) {
        uint8_t seed_shr15 = seed >> 15;
        m->noise_buffer[i] = noise_table[seed_shr15];
        seed = (seed << 8) ^ seed_shr15 ^ (seed_shr15 << 5);
    }

    s->noisegen_seed = seed;
}


/** Apply the channel matrices in turn to reconstruct the original audio
 *  samples. */

static void rematrix_channels(MLPDecodeContext *m, unsigned int substr)
{
    SubStream *s = &m->substream[substr];
    unsigned int mat, src_ch, i;
    unsigned int maxchan;

    maxchan = s->max_matrix_channel;
    if (!s->noise_type) {
        generate_2_noise_channels(m, substr);
        maxchan += 2;
    } else {
        fill_noise_buffer(m, substr);
    }

    for (mat = 0; mat < s->num_primitive_matrices; mat++) {
        int matrix_noise_shift = s->matrix_noise_shift[mat];
        unsigned int dest_ch = s->matrix_out_ch[mat];
        int32_t mask = MSB_MASK(s->quant_step_size[dest_ch]);

        /* TODO: DSPContext? */

        for (i = 0; i < s->blockpos; i++) {
            int64_t accum = 0;
            for (src_ch = 0; src_ch <= maxchan; src_ch++) {
                accum += (int64_t)m->sample_buffer[i][src_ch]
                                  * s->matrix_coeff[mat][src_ch];
            }
            if (matrix_noise_shift) {
                uint32_t index = s->num_primitive_matrices - mat;
                index = (i * (index * 2 + 1) + index) & (m->access_unit_size_pow2 - 1);
                accum += m->noise_buffer[index] << (matrix_noise_shift + 7);
            }
            m->sample_buffer[i][dest_ch] = ((accum >> 14) & mask)
                                             + m->bypassed_lsbs[i][mat];
        }
    }
}

/** Write the audio data into the output buffer. */

static int output_data_internal(MLPDecodeContext *m, unsigned int substr,
                                uint8_t *data, unsigned int *data_size, int is32)
{
    SubStream *s = &m->substream[substr];
861
    unsigned int i, out_ch = 0;
Ramiro Polla's avatar
Ramiro Polla committed
862 863 864 865 866 867 868
    int32_t *data_32 = (int32_t*) data;
    int16_t *data_16 = (int16_t*) data;

    if (*data_size < (s->max_channel + 1) * s->blockpos * (is32 ? 4 : 2))
        return -1;

    for (i = 0; i < s->blockpos; i++) {
869 870 871 872 873
        for (out_ch = 0; out_ch <= s->max_matrix_channel; out_ch++) {
            int mat_ch = s->ch_assign[out_ch];
            int32_t sample = m->sample_buffer[i][mat_ch]
                          << s->output_shift[mat_ch];
            s->lossless_check_data ^= (sample & 0xffffff) << mat_ch;
Ramiro Polla's avatar
Ramiro Polla committed
874 875 876 877 878
            if (is32) *data_32++ = sample << 8;
            else      *data_16++ = sample >> 8;
        }
    }

879
    *data_size = i * out_ch * (is32 ? 4 : 2);
Ramiro Polla's avatar
Ramiro Polla committed
880 881 882 883 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 911 912 913 914 915 916 917 918 919 920 921

    return 0;
}

static int output_data(MLPDecodeContext *m, unsigned int substr,
                       uint8_t *data, unsigned int *data_size)
{
    if (m->avctx->sample_fmt == SAMPLE_FMT_S32)
        return output_data_internal(m, substr, data, data_size, 1);
    else
        return output_data_internal(m, substr, data, data_size, 0);
}


/** Read an access unit from the stream.
 *  Returns < 0 on error, 0 if not enough data is present in the input stream
 *  otherwise returns the number of bytes consumed. */

static int read_access_unit(AVCodecContext *avctx, void* data, int *data_size,
                            const uint8_t *buf, int buf_size)
{
    MLPDecodeContext *m = avctx->priv_data;
    GetBitContext gb;
    unsigned int length, substr;
    unsigned int substream_start;
    unsigned int header_size = 4;
    unsigned int substr_header_size = 0;
    uint8_t substream_parity_present[MAX_SUBSTREAMS];
    uint16_t substream_data_len[MAX_SUBSTREAMS];
    uint8_t parity_bits;

    if (buf_size < 4)
        return 0;

    length = (AV_RB16(buf) & 0xfff) * 2;

    if (length > buf_size)
        return -1;

    init_get_bits(&gb, (buf + 4), (length - 4) * 8);

    if (show_bits_long(&gb, 31) == (0xf8726fba >> 1)) {
Diego Biurrun's avatar
Diego Biurrun committed
922
        dprintf(m->avctx, "Found major sync.\n");
Ramiro Polla's avatar
Ramiro Polla committed
923 924 925 926 927 928 929
        if (read_major_sync(m, &gb) < 0)
            goto error;
        header_size += 28;
    }

    if (!m->params_valid) {
        av_log(m->avctx, AV_LOG_WARNING,
Diego Biurrun's avatar
Diego Biurrun committed
930
               "Stream parameters not seen; skipping frame.\n");
Ramiro Polla's avatar
Ramiro Polla committed
931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976
        *data_size = 0;
        return length;
    }

    substream_start = 0;

    for (substr = 0; substr < m->num_substreams; substr++) {
        int extraword_present, checkdata_present, end;

        extraword_present = get_bits1(&gb);
        skip_bits1(&gb);
        checkdata_present = get_bits1(&gb);
        skip_bits1(&gb);

        end = get_bits(&gb, 12) * 2;

        substr_header_size += 2;

        if (extraword_present) {
            skip_bits(&gb, 16);
            substr_header_size += 2;
        }

        if (end + header_size + substr_header_size > length) {
            av_log(m->avctx, AV_LOG_ERROR,
                   "Indicated length of substream %d data goes off end of "
                   "packet.\n", substr);
            end = length - header_size - substr_header_size;
        }

        if (end < substream_start) {
            av_log(avctx, AV_LOG_ERROR,
                   "Indicated end offset of substream %d data "
                   "is smaller than calculated start offset.\n",
                   substr);
            goto error;
        }

        if (substr > m->max_decoded_substream)
            continue;

        substream_parity_present[substr] = checkdata_present;
        substream_data_len[substr] = end - substream_start;
        substream_start = end;
    }

977 978
    parity_bits  = ff_mlp_calculate_parity(buf, 4);
    parity_bits ^= ff_mlp_calculate_parity(buf + header_size, substr_header_size);
Ramiro Polla's avatar
Ramiro Polla committed
979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994

    if ((((parity_bits >> 4) ^ parity_bits) & 0xF) != 0xF) {
        av_log(avctx, AV_LOG_ERROR, "Parity check failed.\n");
        goto error;
    }

    buf += header_size + substr_header_size;

    for (substr = 0; substr <= m->max_decoded_substream; substr++) {
        SubStream *s = &m->substream[substr];
        init_get_bits(&gb, buf, substream_data_len[substr] * 8);

        s->blockpos = 0;
        do {
            if (get_bits1(&gb)) {
                if (get_bits1(&gb)) {
Diego Biurrun's avatar
Diego Biurrun committed
995
                    /* A restart header should be present. */
Ramiro Polla's avatar
Ramiro Polla committed
996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025
                    if (read_restart_header(m, &gb, buf, substr) < 0)
                        goto next_substr;
                    s->restart_seen = 1;
                }

                if (!s->restart_seen) {
                    av_log(m->avctx, AV_LOG_ERROR,
                           "No restart header present in substream %d.\n",
                           substr);
                    goto next_substr;
                }

                if (read_decoding_params(m, &gb, substr) < 0)
                    goto next_substr;
            }

            if (!s->restart_seen) {
                av_log(m->avctx, AV_LOG_ERROR,
                       "No restart header present in substream %d.\n",
                       substr);
                goto next_substr;
            }

            if (read_block_data(m, &gb, substr) < 0)
                return -1;

        } while ((get_bits_count(&gb) < substream_data_len[substr] * 8)
                 && get_bits1(&gb) == 0);

        skip_bits(&gb, (-get_bits_count(&gb)) & 15);
1026
        if (substream_data_len[substr] * 8 - get_bits_count(&gb) >= 32 &&
1027
            (show_bits_long(&gb, 32) == END_OF_STREAM ||
Ramiro Polla's avatar
Ramiro Polla committed
1028 1029 1030
             show_bits_long(&gb, 20) == 0xd234e)) {
            skip_bits(&gb, 18);
            if (substr == m->max_decoded_substream)
Diego Biurrun's avatar
Diego Biurrun committed
1031
                av_log(m->avctx, AV_LOG_INFO, "End of stream indicated.\n");
Ramiro Polla's avatar
Ramiro Polla committed
1032 1033 1034 1035 1036 1037 1038 1039

            if (get_bits1(&gb)) {
                int shorten_by = get_bits(&gb, 13);
                shorten_by = FFMIN(shorten_by, s->blockpos);
                s->blockpos -= shorten_by;
            } else
                skip_bits(&gb, 13);
        }
1040 1041
        if (substream_data_len[substr] * 8 - get_bits_count(&gb) >= 16 &&
            substream_parity_present[substr]) {
Ramiro Polla's avatar
Ramiro Polla committed
1042 1043
            uint8_t parity, checksum;

1044
            parity = ff_mlp_calculate_parity(buf, substream_data_len[substr] - 2);
Ramiro Polla's avatar
Ramiro Polla committed
1045 1046
            if ((parity ^ get_bits(&gb, 8)) != 0xa9)
                av_log(m->avctx, AV_LOG_ERROR,
Diego Biurrun's avatar
Diego Biurrun committed
1047
                       "Substream %d parity check failed.\n", substr);
Ramiro Polla's avatar
Ramiro Polla committed
1048

1049
            checksum = ff_mlp_checksum8(buf, substream_data_len[substr] - 2);
Ramiro Polla's avatar
Ramiro Polla committed
1050
            if (checksum != get_bits(&gb, 8))
Diego Biurrun's avatar
Diego Biurrun committed
1051
                av_log(m->avctx, AV_LOG_ERROR, "Substream %d checksum failed.\n",
Ramiro Polla's avatar
Ramiro Polla committed
1052 1053 1054
                       substr);
        }
        if (substream_data_len[substr] * 8 != get_bits_count(&gb)) {
Diego Biurrun's avatar
Diego Biurrun committed
1055
            av_log(m->avctx, AV_LOG_ERROR, "substream %d length mismatch\n",
Ramiro Polla's avatar
Ramiro Polla committed
1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075
                   substr);
            return -1;
        }

next_substr:
        buf += substream_data_len[substr];
    }

    rematrix_channels(m, m->max_decoded_substream);

    if (output_data(m, m->max_decoded_substream, data, data_size) < 0)
        return -1;

    return length;

error:
    m->params_valid = 0;
    return -1;
}

Ramiro Polla's avatar
Ramiro Polla committed
1076
#if CONFIG_MLP_DECODER
Ramiro Polla's avatar
Ramiro Polla committed
1077 1078 1079 1080 1081 1082 1083 1084 1085
AVCodec mlp_decoder = {
    "mlp",
    CODEC_TYPE_AUDIO,
    CODEC_ID_MLP,
    sizeof(MLPDecodeContext),
    mlp_decode_init,
    NULL,
    NULL,
    read_access_unit,
Ramiro Polla's avatar
Ramiro Polla committed
1086
    .long_name = NULL_IF_CONFIG_SMALL("MLP (Meridian Lossless Packing)"),
Ramiro Polla's avatar
Ramiro Polla committed
1087
};
Ramiro Polla's avatar
Ramiro Polla committed
1088
#endif /* CONFIG_MLP_DECODER */
Ramiro Polla's avatar
Ramiro Polla committed
1089

Ramiro Polla's avatar
Ramiro Polla committed
1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102
#if CONFIG_TRUEHD_DECODER
AVCodec truehd_decoder = {
    "truehd",
    CODEC_TYPE_AUDIO,
    CODEC_ID_TRUEHD,
    sizeof(MLPDecodeContext),
    mlp_decode_init,
    NULL,
    NULL,
    read_access_unit,
    .long_name = NULL_IF_CONFIG_SMALL("TrueHD"),
};
#endif /* CONFIG_TRUEHD_DECODER */