libavcodec/mlpdec.c
b517af05
 /*
  * 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
  */
 
 /**
ba87f080
  * @file
b517af05
  * MLP decoder
  */
 
0e74e1ff
 #include <stdint.h>
 
b517af05
 #include "avcodec.h"
 #include "libavutil/intreadwrite.h"
99ccd2ba
 #include "libavutil/channel_layout.h"
9106a698
 #include "get_bits.h"
594d4d5d
 #include "internal.h"
b517af05
 #include "libavutil/crc.h"
 #include "parser.h"
 #include "mlp_parser.h"
2d6caade
 #include "mlpdsp.h"
ce15710f
 #include "mlp.h"
b517af05
 
9906a2be
 /** number of bits used for VLC lookup - longest Huffman code is 9 */
b517af05
 #define VLC_BITS            9
 
 typedef struct SubStream {
c68fafe0
     /// Set if a valid restart header has been read. Otherwise the substream cannot be decoded.
b517af05
     uint8_t     restart_seen;
 
     //@{
     /** restart header data */
c68fafe0
     /// The type of noise to be used in the rematrix stage.
b517af05
     uint16_t    noise_type;
 
c68fafe0
     /// The index of the first channel coded in this substream.
b517af05
     uint8_t     min_channel;
c68fafe0
     /// The index of the last channel coded in this substream.
b517af05
     uint8_t     max_channel;
c68fafe0
     /// The number of channels input into the rematrix stage.
b517af05
     uint8_t     max_matrix_channel;
c68fafe0
     /// For each channel output by the matrix, the output channel to map it to
9731e7f1
     uint8_t     ch_assign[MAX_CHANNELS];
99ccd2ba
     /// The channel layout for this substream
     uint64_t    ch_layout;
b517af05
 
c68fafe0
     /// Channel coding parameters for channels in the substream
22fb814c
     ChannelParams channel_params[MAX_CHANNELS];
 
c68fafe0
     /// The left shift applied to random noise in 0x31ea substreams.
b517af05
     uint8_t     noise_shift;
c68fafe0
     /// The current seed value for the pseudorandom noise generator(s).
b517af05
     uint32_t    noisegen_seed;
 
c68fafe0
     /// Set if the substream contains extra info to check the size of VLC blocks.
b517af05
     uint8_t     data_check_present;
 
c68fafe0
     /// Bitmask of which parameter sets are conveyed in a decoding parameter block.
b517af05
     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)
cbf3cf19
 #define PARAM_PRESENCE      (1 << 0)
b517af05
     //@}
 
     //@{
     /** matrix data */
 
c68fafe0
     /// Number of matrices to be applied.
b517af05
     uint8_t     num_primitive_matrices;
 
c68fafe0
     /// matrix output channel
b517af05
     uint8_t     matrix_out_ch[MAX_MATRICES];
 
c68fafe0
     /// Whether the LSBs of the matrix output are encoded in the bitstream.
b517af05
     uint8_t     lsb_bypass[MAX_MATRICES];
c68fafe0
     /// Matrix coefficients, stored as 2.14 fixed point.
420df930
     int32_t     matrix_coeff[MAX_MATRICES][MAX_CHANNELS];
c68fafe0
     /// Left shift to apply to noise values in 0x31eb substreams.
b517af05
     uint8_t     matrix_noise_shift[MAX_MATRICES];
     //@}
 
c68fafe0
     /// Left shift to apply to Huffman-decoded residuals.
b517af05
     uint8_t     quant_step_size[MAX_CHANNELS];
 
c68fafe0
     /// number of PCM samples in current audio block
b517af05
     uint16_t    blocksize;
c68fafe0
     /// Number of PCM samples decoded so far in this frame.
b517af05
     uint16_t    blockpos;
 
c68fafe0
     /// Left shift to apply to decoded PCM values to get final 24-bit output.
b517af05
     int8_t      output_shift[MAX_CHANNELS];
 
c68fafe0
     /// Running XOR of all output samples.
b517af05
     int32_t     lossless_check_data;
 
 } SubStream;
 
 typedef struct MLPDecodeContext {
     AVCodecContext *avctx;
 
c68fafe0
     /// Current access unit being read has a major sync.
cc9c5126
     int         is_major_sync_unit;
 
c68fafe0
     /// Set if a valid major sync block has been read. Otherwise no decoding is possible.
b517af05
     uint8_t     params_valid;
 
c68fafe0
     /// Number of substreams contained within this stream.
b517af05
     uint8_t     num_substreams;
 
c68fafe0
     /// Index of the last substream to decode - further substreams are skipped.
b517af05
     uint8_t     max_decoded_substream;
 
b404ab9e
     /// Stream needs channel reordering to comply with FFmpeg's channel order
939a12e2
     uint8_t     needs_reordering;
 
c68fafe0
     /// number of PCM samples contained in each frame
b517af05
     int         access_unit_size;
c68fafe0
     /// next power of two above the number of samples in each frame
b517af05
     int         access_unit_size_pow2;
 
     SubStream   substream[MAX_SUBSTREAMS];
 
75428fa4
     int         matrix_changed;
     int         filter_changed[MAX_CHANNELS][NUM_FILTERS];
 
b517af05
     int8_t      noise_buffer[MAX_BLOCKSIZE_POW2];
     int8_t      bypassed_lsbs[MAX_BLOCKSIZE][MAX_CHANNELS];
420df930
     int32_t     sample_buffer[MAX_BLOCKSIZE][MAX_CHANNELS];
bf4f19dc
 
2d6caade
     MLPDSPContext dsp;
b517af05
 } MLPDecodeContext;
 
3ffcccb4
 static const uint64_t thd_channel_order[] = {
     AV_CH_FRONT_LEFT, AV_CH_FRONT_RIGHT,                     // LR
     AV_CH_FRONT_CENTER,                                      // C
     AV_CH_LOW_FREQUENCY,                                     // LFE
     AV_CH_SIDE_LEFT, AV_CH_SIDE_RIGHT,                       // LRs
     AV_CH_TOP_FRONT_LEFT, AV_CH_TOP_FRONT_RIGHT,             // LRvh
     AV_CH_FRONT_LEFT_OF_CENTER, AV_CH_FRONT_RIGHT_OF_CENTER, // LRc
     AV_CH_BACK_LEFT, AV_CH_BACK_RIGHT,                       // LRrs
     AV_CH_BACK_CENTER,                                       // Cs
     AV_CH_TOP_CENTER,                                        // Ts
     AV_CH_SURROUND_DIRECT_LEFT, AV_CH_SURROUND_DIRECT_RIGHT, // LRsd
     AV_CH_WIDE_LEFT, AV_CH_WIDE_RIGHT,                       // LRw
     AV_CH_TOP_FRONT_CENTER,                                  // Cvh
     AV_CH_LOW_FREQUENCY_2,                                   // LFE2
 };
 
 static uint64_t thd_channel_layout_extract_channel(uint64_t channel_layout,
                                                    int index)
 {
     int i;
 
     if (av_get_channel_layout_nb_channels(channel_layout) <= index)
         return 0;
 
     for (i = 0; i < FF_ARRAY_ELEMS(thd_channel_order); i++)
         if (channel_layout & thd_channel_order[i] && !index--)
             return thd_channel_order[i];
     return 0;
 }
 
b517af05
 static VLC huff_vlc[3];
 
 /** Initialize static data, constant between all invocations of the codec. */
 
dc8a7c93
 static av_cold void init_static(void)
b517af05
 {
7fd88069
     if (!huff_vlc[0].bits) {
52ae1e86
         INIT_VLC_STATIC(&huff_vlc[0], VLC_BITS, 18,
                     &ff_mlp_huffman_tables[0][0][1], 2, 1,
                     &ff_mlp_huffman_tables[0][0][0], 2, 1, 512);
         INIT_VLC_STATIC(&huff_vlc[1], VLC_BITS, 16,
                     &ff_mlp_huffman_tables[1][0][1], 2, 1,
                     &ff_mlp_huffman_tables[1][0][0], 2, 1, 512);
         INIT_VLC_STATIC(&huff_vlc[2], VLC_BITS, 15,
                     &ff_mlp_huffman_tables[2][0][1], 2, 1,
                     &ff_mlp_huffman_tables[2][0][0], 2, 1, 512);
7fd88069
     }
b517af05
 
ce15710f
     ff_mlp_init_crc();
b517af05
 }
 
 static inline int32_t calculate_sign_huff(MLPDecodeContext *m,
                                           unsigned int substr, unsigned int ch)
 {
     SubStream *s = &m->substream[substr];
22fb814c
     ChannelParams *cp = &s->channel_params[ch];
f53acb7b
     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;
b517af05
 
f53acb7b
     if (cp->codebook > 0)
b517af05
         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++) {
22fb814c
         ChannelParams *cp = &s->channel_params[channel];
f53acb7b
         int codebook = cp->codebook;
b517af05
         int quant_step_size = s->quant_step_size[channel];
f53acb7b
         int lsb_bits = cp->huff_lsbs - quant_step_size;
b517af05
         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)
82be06bb
             return AVERROR_INVALIDDATA;
b517af05
 
         if (lsb_bits > 0)
             result = (result << lsb_bits) + get_bits(gbp, lsb_bits);
 
f53acb7b
         result  += cp->sign_huff_offset;
b517af05
         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;
2d6caade
     ff_mlpdsp_init(&m->dsp);
ee1a8f62
 
b517af05
     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;
82be06bb
     int substr, ret;
b517af05
 
82be06bb
     if ((ret = ff_mlp_read_major_sync(m->avctx, &mh, gb)) != 0)
         return ret;
b517af05
 
     if (mh.group1_bits == 0) {
9906a2be
         av_log(m->avctx, AV_LOG_ERROR, "invalid/unknown bits per sample\n");
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
     if (mh.group2_bits > mh.group1_bits) {
         av_log(m->avctx, AV_LOG_ERROR,
9906a2be
                "Channel group 2 cannot have more bits per sample than group 1.\n");
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
 
     if (mh.group2_samplerate && mh.group2_samplerate != mh.group1_samplerate) {
         av_log(m->avctx, AV_LOG_ERROR,
9906a2be
                "Channel groups with differing sample rates are not currently supported.\n");
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
 
     if (mh.group1_samplerate == 0) {
9906a2be
         av_log(m->avctx, AV_LOG_ERROR, "invalid/unknown sampling rate\n");
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
     if (mh.group1_samplerate > MAX_SAMPLERATE) {
         av_log(m->avctx, AV_LOG_ERROR,
9906a2be
                "Sampling rate %d is greater than the supported maximum (%d).\n",
b517af05
                mh.group1_samplerate, MAX_SAMPLERATE);
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
     if (mh.access_unit_size > MAX_BLOCKSIZE) {
         av_log(m->avctx, AV_LOG_ERROR,
9906a2be
                "Block size %d is greater than the supported maximum (%d).\n",
b517af05
                mh.access_unit_size, MAX_BLOCKSIZE);
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
     if (mh.access_unit_size_pow2 > MAX_BLOCKSIZE_POW2) {
         av_log(m->avctx, AV_LOG_ERROR,
9906a2be
                "Block size pow2 %d is greater than the supported maximum (%d).\n",
b517af05
                mh.access_unit_size_pow2, MAX_BLOCKSIZE_POW2);
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
 
     if (mh.num_substreams == 0)
82be06bb
         return AVERROR_INVALIDDATA;
36ef5369
     if (m->avctx->codec_id == AV_CODEC_ID_MLP && mh.num_substreams > 2) {
932cee5d
         av_log(m->avctx, AV_LOG_ERROR, "MLP only supports up to 2 substreams.\n");
82be06bb
         return AVERROR_INVALIDDATA;
932cee5d
     }
b517af05
     if (mh.num_substreams > MAX_SUBSTREAMS) {
ca085e66
         av_log_ask_for_sample(m->avctx,
9906a2be
                "Number of substreams %d is larger than the maximum supported "
ca085e66
                "by the decoder.\n", mh.num_substreams);
         return AVERROR_PATCHWELCOME;
b517af05
     }
 
     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;
 
97679e6e
     m->avctx->bits_per_raw_sample = mh.group1_bits;
c687643c
     if (mh.group1_bits > 16)
5d6e4c16
         m->avctx->sample_fmt = AV_SAMPLE_FMT_S32;
ee1a8f62
     else
5d6e4c16
         m->avctx->sample_fmt = AV_SAMPLE_FMT_S16;
b517af05
 
     m->params_valid = 1;
     for (substr = 0; substr < MAX_SUBSTREAMS; substr++)
         m->substream[substr].restart_seen = 0;
 
99ccd2ba
     /* Set the layout for each substream. When there's more than one, the first
      * substream is Stereo. Subsequent substreams' layouts are indicated in the
      * major sync. */
     if (m->avctx->codec_id == AV_CODEC_ID_MLP) {
         if ((substr = (mh.num_substreams > 1)))
             m->substream[0].ch_layout = AV_CH_LAYOUT_STEREO;
         m->substream[substr].ch_layout = mh.channel_layout_mlp;
     } else {
         if ((substr = (mh.num_substreams > 1)))
             m->substream[0].ch_layout = AV_CH_LAYOUT_STEREO;
         if (mh.num_substreams > 2)
             if (mh.channel_layout_thd_stream2)
                 m->substream[2].ch_layout = mh.channel_layout_thd_stream2;
             else
                 m->substream[2].ch_layout = mh.channel_layout_thd_stream1;
         m->substream[substr].ch_layout = mh.channel_layout_thd_stream1;
fa36270c
 
         if (m->avctx->channels<=2 && m->substream[substr].ch_layout == AV_CH_LAYOUT_MONO && m->max_decoded_substream == 1) {
             av_log(m->avctx, AV_LOG_DEBUG, "Mono stream with 2 substreams, ignoring 2nd\n");
             m->max_decoded_substream = 0;
             if (m->avctx->channels==2)
                 m->avctx->channel_layout = AV_CH_LAYOUT_STEREO;
         }
99ccd2ba
     }
 
6747b0be
     m->needs_reordering = mh.channel_arrangement >= 18 && mh.channel_arrangement <= 20;
939a12e2
 
b517af05
     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);
36ef5369
     const int max_matrix_channel = m->avctx->codec_id == AV_CODEC_ID_MLP
868170c4
                                  ? MAX_MATRIX_CHANNEL_MLP
                                  : MAX_MATRIX_CHANNEL_TRUEHD;
a9cd12ee
     int max_channel, min_channel, matrix_channel;
b517af05
 
     sync_word = get_bits(gbp, 13);
 
e8d341ce
     if (sync_word != 0x31ea >> 1) {
b517af05
         av_log(m->avctx, AV_LOG_ERROR,
9906a2be
                "restart header sync incorrect (got 0x%04x)\n", sync_word);
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
 
e8d341ce
     s->noise_type = get_bits1(gbp);
 
36ef5369
     if (m->avctx->codec_id == AV_CODEC_ID_MLP && s->noise_type) {
e8d341ce
         av_log(m->avctx, AV_LOG_ERROR, "MLP must have 0x31ea sync word.\n");
82be06bb
         return AVERROR_INVALIDDATA;
e8d341ce
     }
 
b517af05
     skip_bits(gbp, 16); /* Output timestamp */
 
a9cd12ee
     min_channel    = get_bits(gbp, 4);
     max_channel    = get_bits(gbp, 4);
     matrix_channel = get_bits(gbp, 4);
b517af05
 
a9cd12ee
     if (matrix_channel > max_matrix_channel) {
868170c4
         av_log(m->avctx, AV_LOG_ERROR,
                "Max matrix channel cannot be greater than %d.\n",
                max_matrix_channel);
82be06bb
         return AVERROR_INVALIDDATA;
868170c4
     }
 
a9cd12ee
     if (max_channel != matrix_channel) {
868170c4
         av_log(m->avctx, AV_LOG_ERROR,
                "Max channel must be equal max matrix channel.\n");
82be06bb
         return AVERROR_INVALIDDATA;
868170c4
     }
 
e2822726
     /* This should happen for TrueHD streams with >6 channels and MLP's noise
      * type. It is not yet known if this is allowed. */
a9cd12ee
     if (max_channel > MAX_MATRIX_CHANNEL_MLP && !s->noise_type) {
ca085e66
         av_log_ask_for_sample(m->avctx,
e2822726
                "Number of channels %d is larger than the maximum supported "
a9cd12ee
                "by the decoder.\n", max_channel + 2);
ca085e66
         return AVERROR_PATCHWELCOME;
e2822726
     }
 
a9cd12ee
     if (min_channel > max_channel) {
b517af05
         av_log(m->avctx, AV_LOG_ERROR,
                "Substream min channel cannot be greater than max channel.\n");
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
 
a9cd12ee
     s->min_channel = min_channel;
     s->max_channel = max_channel;
     s->max_matrix_channel = matrix_channel;
 
ed1b0113
 #if FF_API_REQUEST_CHANNELS
     if (m->avctx->request_channels > 0 &&
         m->avctx->request_channels <= s->max_channel + 1 &&
         m->max_decoded_substream > substr) {
d780511b
         av_log(m->avctx, AV_LOG_DEBUG,
ed1b0113
                "Extracting %d-channel downmix from substream %d. "
b517af05
                "Further substreams will be skipped.\n",
                s->max_channel + 1, substr);
         m->max_decoded_substream = substr;
ed1b0113
     } else
 #endif
     if (m->avctx->request_channel_layout == s->ch_layout &&
         m->max_decoded_substream > substr) {
         av_log(m->avctx, AV_LOG_DEBUG,
                "Extracting %d-channel downmix (0x%"PRIx64") from substream %d. "
                "Further substreams will be skipped.\n",
                s->max_channel + 1, s->ch_layout, substr);
         m->max_decoded_substream = substr;
b517af05
     }
 
     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) {
a7cc783d
         tmp = xor_32_to_8(s->lossless_check_data);
b517af05
         if (tmp != lossless_check)
             av_log(m->avctx, AV_LOG_WARNING,
9906a2be
                    "Lossless check failed - expected %02x, calculated %02x.\n",
b517af05
                    lossless_check, tmp);
     }
 
     skip_bits(gbp, 16);
 
9731e7f1
     memset(s->ch_assign, 0, sizeof(s->ch_assign));
 
b517af05
     for (ch = 0; ch <= s->max_matrix_channel; ch++) {
         int ch_assign = get_bits(gbp, 6);
3ffcccb4
         if (m->avctx->codec_id == AV_CODEC_ID_TRUEHD) {
             uint64_t channel = thd_channel_layout_extract_channel(s->ch_layout,
                                                                   ch_assign);
             ch_assign = av_get_channel_layout_channel_index(s->ch_layout,
                                                             channel);
         }
8491ac3a
         if ((unsigned)ch_assign > s->max_matrix_channel) {
ca085e66
             av_log_ask_for_sample(m->avctx,
                    "Assignment of matrix channel %d to invalid output channel %d.\n",
                    ch, ch_assign);
             return AVERROR_PATCHWELCOME;
b517af05
         }
9731e7f1
         s->ch_assign[ch_assign] = ch;
b517af05
     }
 
ce15710f
     checksum = ff_mlp_restart_checksum(buf, get_bits_count(gbp) - start_count);
b517af05
 
     if (checksum != get_bits(gbp, 8))
9906a2be
         av_log(m->avctx, AV_LOG_ERROR, "restart header checksum error\n");
b517af05
 
9906a2be
     /* Set default decoding parameters. */
b517af05
     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++) {
22fb814c
         ChannelParams *cp = &s->channel_params[ch];
f53acb7b
         cp->filter_params[FIR].order = 0;
         cp->filter_params[IIR].order = 0;
         cp->filter_params[FIR].shift = 0;
         cp->filter_params[IIR].shift = 0;
b517af05
 
9906a2be
         /* Default audio coding is 24-bit raw PCM. */
f53acb7b
         cp->huff_offset      = 0;
         cp->sign_huff_offset = (-1) << 23;
         cp->codebook         = 0;
         cp->huff_lsbs        = 24;
b517af05
     }
 
1fd2deed
     if (substr == m->max_decoded_substream) {
         m->avctx->channels       = s->max_matrix_channel + 1;
         m->avctx->channel_layout = s->ch_layout;
80712886
 
         if (m->avctx->codec_id == AV_CODEC_ID_MLP && m->needs_reordering) {
             if (m->avctx->channel_layout == (AV_CH_LAYOUT_QUAD|AV_CH_LOW_FREQUENCY) ||
                 m->avctx->channel_layout == AV_CH_LAYOUT_5POINT0_BACK) {
                 int i = s->ch_assign[4];
                 s->ch_assign[4] = s->ch_assign[3];
                 s->ch_assign[3] = s->ch_assign[2];
                 s->ch_assign[2] = i;
             } else if (m->avctx->channel_layout == AV_CH_LAYOUT_5POINT1_BACK) {
                 FFSWAP(int, s->ch_assign[2], s->ch_assign[4]);
                 FFSWAP(int, s->ch_assign[3], s->ch_assign[5]);
             }
         }
 
e6701d51
     }
b517af05
 
     return 0;
 }
 
 /** Read parameters for one of the prediction filters. */
 
 static int read_filter_params(MLPDecodeContext *m, GetBitContext *gbp,
22fb814c
                               unsigned int substr, unsigned int channel,
                               unsigned int filter)
b517af05
 {
22fb814c
     SubStream *s = &m->substream[substr];
     FilterParams *fp = &s->channel_params[channel].filter_params[filter];
0c5670a0
     const int max_order = filter ? MAX_IIR_ORDER : MAX_FIR_ORDER;
b517af05
     const char fchar = filter ? 'I' : 'F';
     int i, order;
 
9906a2be
     // Filter is 0 for FIR, 1 for IIR.
60f32910
     av_assert0(filter < 2);
b517af05
 
5d9e4eaa
     if (m->filter_changed[channel][filter]++ > 1) {
         av_log(m->avctx, AV_LOG_ERROR, "Filters may change only once per access unit.\n");
82be06bb
         return AVERROR_INVALIDDATA;
5d9e4eaa
     }
75428fa4
 
b517af05
     order = get_bits(gbp, 4);
0c5670a0
     if (order > max_order) {
b517af05
         av_log(m->avctx, AV_LOG_ERROR,
9906a2be
                "%cIR filter order %d is greater than maximum %d.\n",
0c5670a0
                fchar, order, max_order);
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
d6aa052d
     fp->order = order;
b517af05
 
     if (order > 0) {
22fb814c
         int32_t *fcoeff = s->channel_params[channel].coeff[filter];
b517af05
         int coeff_bits, coeff_shift;
 
d6aa052d
         fp->shift = get_bits(gbp, 4);
b517af05
 
         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,
9906a2be
                    "%cIR filter coeff_bits must be between 1 and 16.\n",
b517af05
                    fchar);
82be06bb
             return AVERROR_INVALIDDATA;
b517af05
         }
         if (coeff_bits + coeff_shift > 16) {
             av_log(m->avctx, AV_LOG_ERROR,
9906a2be
                    "Sum of coeff_bits and coeff_shift for %cIR filter must be 16 or less.\n",
b517af05
                    fchar);
82be06bb
             return AVERROR_INVALIDDATA;
b517af05
         }
 
         for (i = 0; i < order; i++)
13bd2044
             fcoeff[i] = get_sbits(gbp, coeff_bits) << coeff_shift;
b517af05
 
         if (get_bits1(gbp)) {
             int state_bits, state_shift;
 
             if (filter == FIR) {
                 av_log(m->avctx, AV_LOG_ERROR,
9906a2be
                        "FIR filter has state data specified.\n");
82be06bb
                 return AVERROR_INVALIDDATA;
b517af05
             }
 
             state_bits  = get_bits(gbp, 4);
             state_shift = get_bits(gbp, 4);
 
9906a2be
             /* TODO: Check validity of state data. */
b517af05
 
             for (i = 0; i < order; i++)
db01fa13
                 fp->state[i] = get_sbits(gbp, state_bits) << state_shift;
b517af05
         }
     }
 
     return 0;
 }
 
f8e6293b
 /** Read parameters for primitive matrices. */
 
95c14b1e
 static int read_matrix_params(MLPDecodeContext *m, unsigned int substr, GetBitContext *gbp)
f8e6293b
 {
95c14b1e
     SubStream *s = &m->substream[substr];
f8e6293b
     unsigned int mat, ch;
36ef5369
     const int max_primitive_matrices = m->avctx->codec_id == AV_CODEC_ID_MLP
309616b2
                                      ? MAX_MATRICES_MLP
                                      : MAX_MATRICES_TRUEHD;
f8e6293b
 
5d9e4eaa
     if (m->matrix_changed++ > 1) {
         av_log(m->avctx, AV_LOG_ERROR, "Matrices may change only once per access unit.\n");
82be06bb
         return AVERROR_INVALIDDATA;
5d9e4eaa
     }
 
f8e6293b
     s->num_primitive_matrices = get_bits(gbp, 4);
 
309616b2
     if (s->num_primitive_matrices > max_primitive_matrices) {
         av_log(m->avctx, AV_LOG_ERROR,
                "Number of primitive matrices cannot be greater than %d.\n",
                max_primitive_matrices);
82be06bb
         return AVERROR_INVALIDDATA;
309616b2
     }
 
f8e6293b
     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);
 
0091d8a1
         if (s->matrix_out_ch[mat] > s->max_matrix_channel) {
f8e6293b
             av_log(m->avctx, AV_LOG_ERROR,
                     "Invalid channel %d specified as output from matrix.\n",
                     s->matrix_out_ch[mat]);
82be06bb
             return AVERROR_INVALIDDATA;
f8e6293b
         }
         if (frac_bits > 14) {
             av_log(m->avctx, AV_LOG_ERROR,
                     "Too many fractional bits specified.\n");
82be06bb
             return AVERROR_INVALIDDATA;
f8e6293b
         }
 
         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;
 }
 
43ee5fe0
 /** Read channel parameters. */
 
 static int read_channel_params(MLPDecodeContext *m, unsigned int substr,
                                GetBitContext *gbp, unsigned int ch)
 {
22fb814c
     SubStream *s = &m->substream[substr];
     ChannelParams *cp = &s->channel_params[ch];
43ee5fe0
     FilterParams *fir = &cp->filter_params[FIR];
     FilterParams *iir = &cp->filter_params[IIR];
82be06bb
     int ret;
43ee5fe0
 
     if (s->param_presence_flags & PARAM_FIR)
         if (get_bits1(gbp))
82be06bb
             if ((ret = read_filter_params(m, gbp, substr, ch, FIR)) < 0)
                 return ret;
43ee5fe0
 
     if (s->param_presence_flags & PARAM_IIR)
         if (get_bits1(gbp))
82be06bb
             if ((ret = read_filter_params(m, gbp, substr, ch, IIR)) < 0)
                 return ret;
43ee5fe0
 
125cf771
     if (fir->order + iir->order > 8) {
         av_log(m->avctx, AV_LOG_ERROR, "Total filter orders too high.\n");
82be06bb
         return AVERROR_INVALIDDATA;
125cf771
     }
 
43ee5fe0
     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");
82be06bb
         return AVERROR_INVALIDDATA;
43ee5fe0
     }
     /* The FIR and IIR filters must have the same precision.
aff42ee0
      * 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. */
43ee5fe0
     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);
 
125cf771
     if (cp->huff_lsbs > 24) {
         av_log(m->avctx, AV_LOG_ERROR, "Invalid huff_lsbs.\n");
4aed4f58
         cp->huff_lsbs = 0;
82be06bb
         return AVERROR_INVALIDDATA;
125cf771
     }
43ee5fe0
 
125cf771
     cp->sign_huff_offset = calculate_sign_huff(m, substr, ch);
43ee5fe0
 
     return 0;
 }
 
b517af05
 /** 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];
f8e6293b
     unsigned int ch;
82be06bb
     int ret;
b517af05
 
cbf3cf19
     if (s->param_presence_flags & PARAM_PRESENCE)
f95f6ab9
         if (get_bits1(gbp))
             s->param_presence_flags = get_bits(gbp, 8);
b517af05
 
     if (s->param_presence_flags & PARAM_BLOCKSIZE)
         if (get_bits1(gbp)) {
             s->blocksize = get_bits(gbp, 9);
b864098c
             if (s->blocksize < 8 || s->blocksize > m->access_unit_size) {
53241b5d
                 av_log(m->avctx, AV_LOG_ERROR, "Invalid blocksize.\n");
b517af05
                 s->blocksize = 0;
82be06bb
                 return AVERROR_INVALIDDATA;
b517af05
             }
         }
 
     if (s->param_presence_flags & PARAM_MATRIX)
f95f6ab9
         if (get_bits1(gbp))
82be06bb
             if ((ret = read_matrix_params(m, substr, gbp)) < 0)
                 return ret;
b517af05
 
     if (s->param_presence_flags & PARAM_OUTSHIFT)
         if (get_bits1(gbp))
f95f6ab9
             for (ch = 0; ch <= s->max_matrix_channel; ch++)
af048026
                 s->output_shift[ch] = get_sbits(gbp, 4);
b517af05
 
     if (s->param_presence_flags & PARAM_QUANTSTEP)
         if (get_bits1(gbp))
             for (ch = 0; ch <= s->max_channel; ch++) {
22fb814c
                 ChannelParams *cp = &s->channel_params[ch];
f53acb7b
 
b517af05
                 s->quant_step_size[ch] = get_bits(gbp, 4);
 
f53acb7b
                 cp->sign_huff_offset = calculate_sign_huff(m, substr, ch);
b517af05
             }
 
     for (ch = s->min_channel; ch <= s->max_channel; ch++)
f95f6ab9
         if (get_bits1(gbp))
82be06bb
             if ((ret = read_channel_params(m, substr, gbp, ch)) < 0)
                 return ret;
b517af05
 
     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];
22fb814c
     const int32_t *fircoeff = s->channel_params[channel].coeff[FIR];
13bd2044
     int32_t state_buffer[NUM_FILTERS][MAX_BLOCKSIZE + MAX_FIR_ORDER];
     int32_t *firbuf = state_buffer[FIR] + MAX_BLOCKSIZE;
     int32_t *iirbuf = state_buffer[IIR] + MAX_BLOCKSIZE;
22fb814c
     FilterParams *fir = &s->channel_params[channel].filter_params[FIR];
     FilterParams *iir = &s->channel_params[channel].filter_params[IIR];
e71365f4
     unsigned int filter_shift = fir->shift;
b517af05
     int32_t mask = MSB_MASK(s->quant_step_size[channel]);
 
77b12f80
     memcpy(firbuf, fir->state, MAX_FIR_ORDER * sizeof(int32_t));
     memcpy(iirbuf, iir->state, MAX_IIR_ORDER * sizeof(int32_t));
b517af05
 
13bd2044
     m->dsp.mlp_filter_channel(firbuf, fircoeff,
                               fir->order, iir->order,
bf4f19dc
                               filter_shift, mask, s->blocksize,
                               &m->sample_buffer[s->blockpos][channel]);
b517af05
 
bf4f19dc
     memcpy(fir->state, firbuf - s->blocksize, MAX_FIR_ORDER * sizeof(int32_t));
     memcpy(iir->state, iirbuf - s->blocksize, MAX_IIR_ORDER * sizeof(int32_t));
b517af05
 }
 
 /** 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;
82be06bb
     int ret;
b517af05
 
     if (s->data_check_present) {
         expected_stream_pos  = get_bits_count(gbp);
         expected_stream_pos += get_bits(gbp, 16);
ca085e66
         av_log_ask_for_sample(m->avctx, "This file contains some features "
                               "we have not tested yet.\n");
b517af05
     }
 
     if (s->blockpos + s->blocksize > m->access_unit_size) {
9906a2be
         av_log(m->avctx, AV_LOG_ERROR, "too many audio samples in frame\n");
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
     }
 
     memset(&m->bypassed_lsbs[s->blockpos][0], 0,
            s->blocksize * sizeof(m->bypassed_lsbs[0]));
 
f95f6ab9
     for (i = 0; i < s->blocksize; i++)
82be06bb
         if ((ret = read_huff_channels(m, gbp, substr, i)) < 0)
             return ret;
b517af05
 
f95f6ab9
     for (ch = s->min_channel; ch <= s->max_channel; ch++)
b517af05
         filter_channel(m, substr, ch);
 
     s->blockpos += s->blocksize;
 
     if (s->data_check_present) {
         if (get_bits_count(gbp) != expected_stream_pos)
9906a2be
             av_log(m->avctx, AV_LOG_ERROR, "block data length mismatch\n");
b517af05
         skip_bits(gbp, 8);
     }
 
     return 0;
 }
 
9906a2be
 /** Data table used for TrueHD noise generation function. */
b517af05
 
 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]);
63ad832d
         int32_t *coeffs = s->matrix_coeff[mat];
15e6748b
         int index  = s->num_primitive_matrices - mat;
         int index2 = 2 * index + 1;
b517af05
 
         /* TODO: DSPContext? */
 
         for (i = 0; i < s->blockpos; i++) {
a256445e
             int32_t bypassed_lsb = m->bypassed_lsbs[i][mat];
63ad832d
             int32_t *samples = m->sample_buffer[i];
b517af05
             int64_t accum = 0;
f95f6ab9
 
             for (src_ch = 0; src_ch <= maxchan; src_ch++)
                 accum += (int64_t) samples[src_ch] * coeffs[src_ch];
 
b517af05
             if (matrix_noise_shift) {
15e6748b
                 index &= m->access_unit_size_pow2 - 1;
b517af05
                 accum += m->noise_buffer[index] << (matrix_noise_shift + 7);
15e6748b
                 index += index2;
b517af05
             }
f95f6ab9
 
a256445e
             samples[dest_ch] = ((accum >> 14) & mask) + bypassed_lsb;
b517af05
         }
     }
 }
 
 /** Write the audio data into the output buffer. */
 
e1b8d88d
 static int output_data(MLPDecodeContext *m, unsigned int substr,
dc33fbbf
                        AVFrame *frame, int *got_frame_ptr)
b517af05
 {
0eea2129
     AVCodecContext *avctx = m->avctx;
b517af05
     SubStream *s = &m->substream[substr];
9731e7f1
     unsigned int i, out_ch = 0;
0eea2129
     int32_t *data_32;
     int16_t *data_16;
     int ret;
e1b8d88d
     int is32 = (m->avctx->sample_fmt == AV_SAMPLE_FMT_S32);
b517af05
 
caa84585
     if (m->avctx->channels != s->max_matrix_channel + 1) {
         av_log(m->avctx, AV_LOG_ERROR, "channel count mismatch\n");
         return AVERROR_INVALIDDATA;
     }
 
0dff40bf
     if (!s->blockpos) {
         av_log(avctx, AV_LOG_ERROR, "No samples to output.\n");
         return AVERROR_INVALIDDATA;
     }
caa84585
 
0eea2129
     /* get output buffer */
dc33fbbf
     frame->nb_samples = s->blockpos;
     if ((ret = ff_get_buffer(avctx, frame)) < 0) {
0eea2129
         av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
         return ret;
     }
dc33fbbf
     data_32 = (int32_t *)frame->data[0];
     data_16 = (int16_t *)frame->data[0];
b517af05
 
     for (i = 0; i < s->blockpos; i++) {
9731e7f1
         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;
b517af05
             if (is32) *data_32++ = sample << 8;
             else      *data_16++ = sample >> 8;
         }
     }
 
dc33fbbf
     *got_frame_ptr = 1;
b517af05
 
     return 0;
 }
 
 /** Read an access unit from the stream.
49bd8e4b
  *  @return negative on error, 0 if not enough data is present in the input stream,
  *  otherwise the number of bytes consumed. */
b517af05
 
0eea2129
 static int read_access_unit(AVCodecContext *avctx, void* data,
                             int *got_frame_ptr, AVPacket *avpkt)
b517af05
 {
7a00bbad
     const uint8_t *buf = avpkt->data;
     int buf_size = avpkt->size;
b517af05
     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;
82be06bb
     int ret;
b517af05
 
     if (buf_size < 4)
         return 0;
 
     length = (AV_RB16(buf) & 0xfff) * 2;
 
0b882b40
     if (length < 4 || length > buf_size)
82be06bb
         return AVERROR_INVALIDDATA;
b517af05
 
     init_get_bits(&gb, (buf + 4), (length - 4) * 8);
 
cc9c5126
     m->is_major_sync_unit = 0;
b517af05
     if (show_bits_long(&gb, 31) == (0xf8726fba >> 1)) {
         if (read_major_sync(m, &gb) < 0)
             goto error;
cc9c5126
         m->is_major_sync_unit = 1;
b517af05
         header_size += 28;
     }
 
     if (!m->params_valid) {
         av_log(m->avctx, AV_LOG_WARNING,
9906a2be
                "Stream parameters not seen; skipping frame.\n");
0eea2129
         *got_frame_ptr = 0;
b517af05
         return length;
     }
 
     substream_start = 0;
 
     for (substr = 0; substr < m->num_substreams; substr++) {
cc9c5126
         int extraword_present, checkdata_present, end, nonrestart_substr;
b517af05
 
         extraword_present = get_bits1(&gb);
cc9c5126
         nonrestart_substr = get_bits1(&gb);
b517af05
         checkdata_present = get_bits1(&gb);
         skip_bits1(&gb);
 
         end = get_bits(&gb, 12) * 2;
 
         substr_header_size += 2;
 
         if (extraword_present) {
36ef5369
             if (m->avctx->codec_id == AV_CODEC_ID_MLP) {
89e39be3
                 av_log(m->avctx, AV_LOG_ERROR, "There must be no extraword for MLP.\n");
                 goto error;
             }
b517af05
             skip_bits(&gb, 16);
             substr_header_size += 2;
         }
 
cc9c5126
         if (!(nonrestart_substr ^ m->is_major_sync_unit)) {
             av_log(m->avctx, AV_LOG_ERROR, "Invalid nonrestart_substr.\n");
             goto error;
         }
 
b517af05
         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;
     }
 
ce15710f
     parity_bits  = ff_mlp_calculate_parity(buf, 4);
     parity_bits ^= ff_mlp_calculate_parity(buf + header_size, substr_header_size);
b517af05
 
     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);
 
75428fa4
         m->matrix_changed = 0;
         memset(m->filter_changed, 0, sizeof(m->filter_changed));
 
b517af05
         s->blockpos = 0;
         do {
             if (get_bits1(&gb)) {
                 if (get_bits1(&gb)) {
9906a2be
                     /* A restart header should be present. */
b517af05
                     if (read_restart_header(m, &gb, buf, substr) < 0)
                         goto next_substr;
                     s->restart_seen = 1;
                 }
 
f95f6ab9
                 if (!s->restart_seen)
b517af05
                     goto next_substr;
                 if (read_decoding_params(m, &gb, substr) < 0)
                     goto next_substr;
             }
 
f95f6ab9
             if (!s->restart_seen)
b517af05
                 goto next_substr;
 
82be06bb
             if ((ret = read_block_data(m, &gb, substr)) < 0)
                 return ret;
b517af05
 
d7952be3
             if (get_bits_count(&gb) >= substream_data_len[substr] * 8)
                 goto substream_length_mismatch;
 
         } while (!get_bits1(&gb));
b517af05
 
         skip_bits(&gb, (-get_bits_count(&gb)) & 15);
f95f6ab9
 
7b18e13a
         if (substream_data_len[substr] * 8 - get_bits_count(&gb) >= 32) {
             int shorten_by;
 
             if (get_bits(&gb, 16) != 0xD234)
82be06bb
                 return AVERROR_INVALIDDATA;
7b18e13a
 
             shorten_by = get_bits(&gb, 16);
36ef5369
             if      (m->avctx->codec_id == AV_CODEC_ID_TRUEHD && shorten_by  & 0x2000)
7b18e13a
                 s->blockpos -= FFMIN(shorten_by & 0x1FFF, s->blockpos);
36ef5369
             else if (m->avctx->codec_id == AV_CODEC_ID_MLP    && shorten_by != 0xD234)
82be06bb
                 return AVERROR_INVALIDDATA;
7b18e13a
 
b517af05
             if (substr == m->max_decoded_substream)
9906a2be
                 av_log(m->avctx, AV_LOG_INFO, "End of stream indicated.\n");
b517af05
         }
f95f6ab9
 
ab79fa44
         if (substream_parity_present[substr]) {
b517af05
             uint8_t parity, checksum;
 
ab79fa44
             if (substream_data_len[substr] * 8 - get_bits_count(&gb) != 16)
                 goto substream_length_mismatch;
 
d544dcdf
             parity   = ff_mlp_calculate_parity(buf, substream_data_len[substr] - 2);
             checksum = ff_mlp_checksum8       (buf, substream_data_len[substr] - 2);
b517af05
 
d544dcdf
             if ((get_bits(&gb, 8) ^ parity) != 0xa9    )
                 av_log(m->avctx, AV_LOG_ERROR, "Substream %d parity check failed.\n", substr);
             if ( get_bits(&gb, 8)           != checksum)
                 av_log(m->avctx, AV_LOG_ERROR, "Substream %d checksum failed.\n"    , substr);
b517af05
         }
f95f6ab9
 
         if (substream_data_len[substr] * 8 != get_bits_count(&gb))
d7952be3
             goto substream_length_mismatch;
b517af05
 
 next_substr:
f95f6ab9
         if (!s->restart_seen)
01aaf092
             av_log(m->avctx, AV_LOG_ERROR,
                    "No restart header present in substream %d.\n", substr);
 
b517af05
         buf += substream_data_len[substr];
     }
 
     rematrix_channels(m, m->max_decoded_substream);
 
0eea2129
     if ((ret = output_data(m, m->max_decoded_substream, data, got_frame_ptr)) < 0)
82be06bb
         return ret;
b517af05
 
     return length;
 
d7952be3
 substream_length_mismatch:
     av_log(m->avctx, AV_LOG_ERROR, "substream %d length mismatch\n", substr);
82be06bb
     return AVERROR_INVALIDDATA;
d7952be3
 
b517af05
 error:
     m->params_valid = 0;
82be06bb
     return AVERROR_INVALIDDATA;
b517af05
 }
 
137e8081
 #if CONFIG_MLP_DECODER
e7e2df27
 AVCodec ff_mlp_decoder = {
ec6402b7
     .name           = "mlp",
     .type           = AVMEDIA_TYPE_AUDIO,
36ef5369
     .id             = AV_CODEC_ID_MLP,
ec6402b7
     .priv_data_size = sizeof(MLPDecodeContext),
     .init           = mlp_decode_init,
     .decode         = read_access_unit,
0eea2129
     .capabilities   = CODEC_CAP_DR1,
00c3b67b
     .long_name      = NULL_IF_CONFIG_SMALL("MLP (Meridian Lossless Packing)"),
b517af05
 };
137e8081
 #endif
9ba4821d
 #if CONFIG_TRUEHD_DECODER
e7e2df27
 AVCodec ff_truehd_decoder = {
ec6402b7
     .name           = "truehd",
     .type           = AVMEDIA_TYPE_AUDIO,
36ef5369
     .id             = AV_CODEC_ID_TRUEHD,
ec6402b7
     .priv_data_size = sizeof(MLPDecodeContext),
     .init           = mlp_decode_init,
     .decode         = read_access_unit,
0eea2129
     .capabilities   = CODEC_CAP_DR1,
00c3b67b
     .long_name      = NULL_IF_CONFIG_SMALL("TrueHD"),
9ba4821d
 };
 #endif /* CONFIG_TRUEHD_DECODER */