~ubuntu-branches/ubuntu/jaunty/xvidcap/jaunty-proposed

« back to all changes in this revision

Viewing changes to ffmpeg/libavcodec/dca.c

  • Committer: Bazaar Package Importer
  • Author(s): John Dong
  • Date: 2008-02-25 15:47:12 UTC
  • mfrom: (1.1.1 upstream)
  • Revision ID: james.westby@ubuntu.com-20080225154712-qvr11ekcea4c9ry8
Tags: 1.1.6-0.1ubuntu1
* Merge from debian-multimedia (LP: #120003), Ubuntu Changes:
 - For ffmpeg-related build-deps, remove cvs from package names.
 - Standards-Version 3.7.3
 - Maintainer Spec

Show diffs side-by-side

added added

removed removed

Lines of Context:
 
1
/*
 
2
 * DCA compatible decoder
 
3
 * Copyright (C) 2004 Gildas Bazin
 
4
 * Copyright (C) 2004 Benjamin Zores
 
5
 * Copyright (C) 2006 Benjamin Larsson
 
6
 * Copyright (C) 2007 Konstantin Shishkov
 
7
 *
 
8
 * This file is part of FFmpeg.
 
9
 *
 
10
 * FFmpeg is free software; you can redistribute it and/or
 
11
 * modify it under the terms of the GNU Lesser General Public
 
12
 * License as published by the Free Software Foundation; either
 
13
 * version 2.1 of the License, or (at your option) any later version.
 
14
 *
 
15
 * FFmpeg is distributed in the hope that it will be useful,
 
16
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 
17
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 
18
 * Lesser General Public License for more details.
 
19
 *
 
20
 * You should have received a copy of the GNU Lesser General Public
 
21
 * License along with FFmpeg; if not, write to the Free Software
 
22
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
 
23
 */
 
24
 
 
25
/**
 
26
 * @file dca.c
 
27
 */
 
28
 
 
29
#include <math.h>
 
30
#include <stddef.h>
 
31
#include <stdio.h>
 
32
 
 
33
#include "avcodec.h"
 
34
#include "dsputil.h"
 
35
#include "bitstream.h"
 
36
#include "dcadata.h"
 
37
#include "dcahuff.h"
 
38
#include "parser.h"
 
39
 
 
40
/** DCA syncwords, also used for bitstream type detection */
 
41
//@{
 
42
#define DCA_MARKER_RAW_BE 0x7FFE8001
 
43
#define DCA_MARKER_RAW_LE 0xFE7F0180
 
44
#define DCA_MARKER_14B_BE 0x1FFFE800
 
45
#define DCA_MARKER_14B_LE 0xFF1F00E8
 
46
//@}
 
47
 
 
48
//#define TRACE
 
49
 
 
50
#define DCA_PRIM_CHANNELS_MAX (5)
 
51
#define DCA_SUBBANDS (32)
 
52
#define DCA_ABITS_MAX (32)      /* Should be 28 */
 
53
#define DCA_SUBSUBFAMES_MAX (4)
 
54
#define DCA_LFE_MAX (3)
 
55
 
 
56
enum DCAMode {
 
57
    DCA_MONO = 0,
 
58
    DCA_CHANNEL,
 
59
    DCA_STEREO,
 
60
    DCA_STEREO_SUMDIFF,
 
61
    DCA_STEREO_TOTAL,
 
62
    DCA_3F,
 
63
    DCA_2F1R,
 
64
    DCA_3F1R,
 
65
    DCA_2F2R,
 
66
    DCA_3F2R,
 
67
    DCA_4F2R
 
68
};
 
69
 
 
70
#define DCA_DOLBY 101           /* FIXME */
 
71
 
 
72
#define DCA_CHANNEL_BITS 6
 
73
#define DCA_CHANNEL_MASK 0x3F
 
74
 
 
75
#define DCA_LFE 0x80
 
76
 
 
77
#define HEADER_SIZE 14
 
78
#define CONVERT_BIAS 384
 
79
 
 
80
#define DCA_MAX_FRAME_SIZE 16383
 
81
 
 
82
/** Bit allocation */
 
83
typedef struct {
 
84
    int offset;                 ///< code values offset
 
85
    int maxbits[8];             ///< max bits in VLC
 
86
    int wrap;                   ///< wrap for get_vlc2()
 
87
    VLC vlc[8];                 ///< actual codes
 
88
} BitAlloc;
 
89
 
 
90
static BitAlloc dca_bitalloc_index;    ///< indexes for samples VLC select
 
91
static BitAlloc dca_tmode;             ///< transition mode VLCs
 
92
static BitAlloc dca_scalefactor;       ///< scalefactor VLCs
 
93
static BitAlloc dca_smpl_bitalloc[11]; ///< samples VLCs
 
94
 
 
95
/** Pre-calculated cosine modulation coefs for the QMF */
 
96
static float cos_mod[544];
 
97
 
 
98
static int av_always_inline get_bitalloc(GetBitContext *gb, BitAlloc *ba, int idx)
 
99
{
 
100
    return get_vlc2(gb, ba->vlc[idx].table, ba->vlc[idx].bits, ba->wrap) + ba->offset;
 
101
}
 
102
 
 
103
typedef struct {
 
104
    AVCodecContext *avctx;
 
105
    /* Frame header */
 
106
    int frame_type;             ///< type of the current frame
 
107
    int samples_deficit;        ///< deficit sample count
 
108
    int crc_present;            ///< crc is present in the bitstream
 
109
    int sample_blocks;          ///< number of PCM sample blocks
 
110
    int frame_size;             ///< primary frame byte size
 
111
    int amode;                  ///< audio channels arrangement
 
112
    int sample_rate;            ///< audio sampling rate
 
113
    int bit_rate;               ///< transmission bit rate
 
114
 
 
115
    int downmix;                ///< embedded downmix enabled
 
116
    int dynrange;               ///< embedded dynamic range flag
 
117
    int timestamp;              ///< embedded time stamp flag
 
118
    int aux_data;               ///< auxiliary data flag
 
119
    int hdcd;                   ///< source material is mastered in HDCD
 
120
    int ext_descr;              ///< extension audio descriptor flag
 
121
    int ext_coding;             ///< extended coding flag
 
122
    int aspf;                   ///< audio sync word insertion flag
 
123
    int lfe;                    ///< low frequency effects flag
 
124
    int predictor_history;      ///< predictor history flag
 
125
    int header_crc;             ///< header crc check bytes
 
126
    int multirate_inter;        ///< multirate interpolator switch
 
127
    int version;                ///< encoder software revision
 
128
    int copy_history;           ///< copy history
 
129
    int source_pcm_res;         ///< source pcm resolution
 
130
    int front_sum;              ///< front sum/difference flag
 
131
    int surround_sum;           ///< surround sum/difference flag
 
132
    int dialog_norm;            ///< dialog normalisation parameter
 
133
 
 
134
    /* Primary audio coding header */
 
135
    int subframes;              ///< number of subframes
 
136
    int prim_channels;          ///< number of primary audio channels
 
137
    int subband_activity[DCA_PRIM_CHANNELS_MAX];    ///< subband activity count
 
138
    int vq_start_subband[DCA_PRIM_CHANNELS_MAX];    ///< high frequency vq start subband
 
139
    int joint_intensity[DCA_PRIM_CHANNELS_MAX];     ///< joint intensity coding index
 
140
    int transient_huffman[DCA_PRIM_CHANNELS_MAX];   ///< transient mode code book
 
141
    int scalefactor_huffman[DCA_PRIM_CHANNELS_MAX]; ///< scale factor code book
 
142
    int bitalloc_huffman[DCA_PRIM_CHANNELS_MAX];    ///< bit allocation quantizer select
 
143
    int quant_index_huffman[DCA_PRIM_CHANNELS_MAX][DCA_ABITS_MAX]; ///< quantization index codebook select
 
144
    float scalefactor_adj[DCA_PRIM_CHANNELS_MAX][DCA_ABITS_MAX];   ///< scale factor adjustment
 
145
 
 
146
    /* Primary audio coding side information */
 
147
    int subsubframes;           ///< number of subsubframes
 
148
    int partial_samples;        ///< partial subsubframe samples count
 
149
    int prediction_mode[DCA_PRIM_CHANNELS_MAX][DCA_SUBBANDS];    ///< prediction mode (ADPCM used or not)
 
150
    int prediction_vq[DCA_PRIM_CHANNELS_MAX][DCA_SUBBANDS];      ///< prediction VQ coefs
 
151
    int bitalloc[DCA_PRIM_CHANNELS_MAX][DCA_SUBBANDS];           ///< bit allocation index
 
152
    int transition_mode[DCA_PRIM_CHANNELS_MAX][DCA_SUBBANDS];    ///< transition mode (transients)
 
153
    int scale_factor[DCA_PRIM_CHANNELS_MAX][DCA_SUBBANDS][2];    ///< scale factors (2 if transient)
 
154
    int joint_huff[DCA_PRIM_CHANNELS_MAX];                       ///< joint subband scale factors codebook
 
155
    int joint_scale_factor[DCA_PRIM_CHANNELS_MAX][DCA_SUBBANDS]; ///< joint subband scale factors
 
156
    int downmix_coef[DCA_PRIM_CHANNELS_MAX][2];                  ///< stereo downmix coefficients
 
157
    int dynrange_coef;                                           ///< dynamic range coefficient
 
158
 
 
159
    int high_freq_vq[DCA_PRIM_CHANNELS_MAX][DCA_SUBBANDS];       ///< VQ encoded high frequency subbands
 
160
 
 
161
    float lfe_data[2 * DCA_SUBSUBFAMES_MAX * DCA_LFE_MAX *
 
162
                   2 /*history */ ];    ///< Low frequency effect data
 
163
    int lfe_scale_factor;
 
164
 
 
165
    /* Subband samples history (for ADPCM) */
 
166
    float subband_samples_hist[DCA_PRIM_CHANNELS_MAX][DCA_SUBBANDS][4];
 
167
    float subband_fir_hist[DCA_PRIM_CHANNELS_MAX][512];
 
168
    float subband_fir_noidea[DCA_PRIM_CHANNELS_MAX][64];
 
169
 
 
170
    int output;                 ///< type of output
 
171
    int bias;                   ///< output bias
 
172
 
 
173
    DECLARE_ALIGNED_16(float, samples[1536]);  /* 6 * 256 = 1536, might only need 5 */
 
174
    DECLARE_ALIGNED_16(int16_t, tsamples[1536]);
 
175
 
 
176
    uint8_t dca_buffer[DCA_MAX_FRAME_SIZE];
 
177
    int dca_buffer_size;        ///< how much data is in the dca_buffer
 
178
 
 
179
    GetBitContext gb;
 
180
    /* Current position in DCA frame */
 
181
    int current_subframe;
 
182
    int current_subsubframe;
 
183
 
 
184
    int debug_flag;             ///< used for suppressing repeated error messages output
 
185
    DSPContext dsp;
 
186
} DCAContext;
 
187
 
 
188
static void dca_init_vlcs()
 
189
{
 
190
    static int vlcs_inited = 0;
 
191
    int i, j;
 
192
 
 
193
    if (vlcs_inited)
 
194
        return;
 
195
 
 
196
    dca_bitalloc_index.offset = 1;
 
197
    dca_bitalloc_index.wrap = 1;
 
198
    for (i = 0; i < 5; i++)
 
199
        init_vlc(&dca_bitalloc_index.vlc[i], bitalloc_12_vlc_bits[i], 12,
 
200
                 bitalloc_12_bits[i], 1, 1,
 
201
                 bitalloc_12_codes[i], 2, 2, 1);
 
202
    dca_scalefactor.offset = -64;
 
203
    dca_scalefactor.wrap = 2;
 
204
    for (i = 0; i < 5; i++)
 
205
        init_vlc(&dca_scalefactor.vlc[i], SCALES_VLC_BITS, 129,
 
206
                 scales_bits[i], 1, 1,
 
207
                 scales_codes[i], 2, 2, 1);
 
208
    dca_tmode.offset = 0;
 
209
    dca_tmode.wrap = 1;
 
210
    for (i = 0; i < 4; i++)
 
211
        init_vlc(&dca_tmode.vlc[i], tmode_vlc_bits[i], 4,
 
212
                 tmode_bits[i], 1, 1,
 
213
                 tmode_codes[i], 2, 2, 1);
 
214
 
 
215
    for(i = 0; i < 10; i++)
 
216
        for(j = 0; j < 7; j++){
 
217
            if(!bitalloc_codes[i][j]) break;
 
218
            dca_smpl_bitalloc[i+1].offset = bitalloc_offsets[i];
 
219
            dca_smpl_bitalloc[i+1].wrap = 1 + (j > 4);
 
220
            init_vlc(&dca_smpl_bitalloc[i+1].vlc[j], bitalloc_maxbits[i][j],
 
221
                     bitalloc_sizes[i],
 
222
                     bitalloc_bits[i][j], 1, 1,
 
223
                     bitalloc_codes[i][j], 2, 2, 1);
 
224
        }
 
225
    vlcs_inited = 1;
 
226
}
 
227
 
 
228
static inline void get_array(GetBitContext *gb, int *dst, int len, int bits)
 
229
{
 
230
    while(len--)
 
231
        *dst++ = get_bits(gb, bits);
 
232
}
 
233
 
 
234
static int dca_parse_frame_header(DCAContext * s)
 
235
{
 
236
    int i, j;
 
237
    static const float adj_table[4] = { 1.0, 1.1250, 1.2500, 1.4375 };
 
238
    static const int bitlen[11] = { 0, 1, 2, 2, 2, 2, 3, 3, 3, 3, 3 };
 
239
    static const int thr[11] = { 0, 1, 3, 3, 3, 3, 7, 7, 7, 7, 7 };
 
240
 
 
241
    s->bias = CONVERT_BIAS;
 
242
 
 
243
    init_get_bits(&s->gb, s->dca_buffer, s->dca_buffer_size * 8);
 
244
 
 
245
    /* Sync code */
 
246
    get_bits(&s->gb, 32);
 
247
 
 
248
    /* Frame header */
 
249
    s->frame_type        = get_bits(&s->gb, 1);
 
250
    s->samples_deficit   = get_bits(&s->gb, 5) + 1;
 
251
    s->crc_present       = get_bits(&s->gb, 1);
 
252
    s->sample_blocks     = get_bits(&s->gb, 7) + 1;
 
253
    s->frame_size        = get_bits(&s->gb, 14) + 1;
 
254
    if (s->frame_size < 95)
 
255
        return -1;
 
256
    s->amode             = get_bits(&s->gb, 6);
 
257
    s->sample_rate       = dca_sample_rates[get_bits(&s->gb, 4)];
 
258
    if (!s->sample_rate)
 
259
        return -1;
 
260
    s->bit_rate          = dca_bit_rates[get_bits(&s->gb, 5)];
 
261
    if (!s->bit_rate)
 
262
        return -1;
 
263
 
 
264
    s->downmix           = get_bits(&s->gb, 1);
 
265
    s->dynrange          = get_bits(&s->gb, 1);
 
266
    s->timestamp         = get_bits(&s->gb, 1);
 
267
    s->aux_data          = get_bits(&s->gb, 1);
 
268
    s->hdcd              = get_bits(&s->gb, 1);
 
269
    s->ext_descr         = get_bits(&s->gb, 3);
 
270
    s->ext_coding        = get_bits(&s->gb, 1);
 
271
    s->aspf              = get_bits(&s->gb, 1);
 
272
    s->lfe               = get_bits(&s->gb, 2);
 
273
    s->predictor_history = get_bits(&s->gb, 1);
 
274
 
 
275
    /* TODO: check CRC */
 
276
    if (s->crc_present)
 
277
        s->header_crc    = get_bits(&s->gb, 16);
 
278
 
 
279
    s->multirate_inter   = get_bits(&s->gb, 1);
 
280
    s->version           = get_bits(&s->gb, 4);
 
281
    s->copy_history      = get_bits(&s->gb, 2);
 
282
    s->source_pcm_res    = get_bits(&s->gb, 3);
 
283
    s->front_sum         = get_bits(&s->gb, 1);
 
284
    s->surround_sum      = get_bits(&s->gb, 1);
 
285
    s->dialog_norm       = get_bits(&s->gb, 4);
 
286
 
 
287
    /* FIXME: channels mixing levels */
 
288
    s->output = DCA_STEREO;
 
289
 
 
290
#ifdef TRACE
 
291
    av_log(s->avctx, AV_LOG_DEBUG, "frame type: %i\n", s->frame_type);
 
292
    av_log(s->avctx, AV_LOG_DEBUG, "samples deficit: %i\n", s->samples_deficit);
 
293
    av_log(s->avctx, AV_LOG_DEBUG, "crc present: %i\n", s->crc_present);
 
294
    av_log(s->avctx, AV_LOG_DEBUG, "sample blocks: %i (%i samples)\n",
 
295
           s->sample_blocks, s->sample_blocks * 32);
 
296
    av_log(s->avctx, AV_LOG_DEBUG, "frame size: %i bytes\n", s->frame_size);
 
297
    av_log(s->avctx, AV_LOG_DEBUG, "amode: %i (%i channels)\n",
 
298
           s->amode, dca_channels[s->amode]);
 
299
    av_log(s->avctx, AV_LOG_DEBUG, "sample rate: %i (%i Hz)\n",
 
300
           s->sample_rate, dca_sample_rates[s->sample_rate]);
 
301
    av_log(s->avctx, AV_LOG_DEBUG, "bit rate: %i (%i bits/s)\n",
 
302
           s->bit_rate, dca_bit_rates[s->bit_rate]);
 
303
    av_log(s->avctx, AV_LOG_DEBUG, "downmix: %i\n", s->downmix);
 
304
    av_log(s->avctx, AV_LOG_DEBUG, "dynrange: %i\n", s->dynrange);
 
305
    av_log(s->avctx, AV_LOG_DEBUG, "timestamp: %i\n", s->timestamp);
 
306
    av_log(s->avctx, AV_LOG_DEBUG, "aux_data: %i\n", s->aux_data);
 
307
    av_log(s->avctx, AV_LOG_DEBUG, "hdcd: %i\n", s->hdcd);
 
308
    av_log(s->avctx, AV_LOG_DEBUG, "ext descr: %i\n", s->ext_descr);
 
309
    av_log(s->avctx, AV_LOG_DEBUG, "ext coding: %i\n", s->ext_coding);
 
310
    av_log(s->avctx, AV_LOG_DEBUG, "aspf: %i\n", s->aspf);
 
311
    av_log(s->avctx, AV_LOG_DEBUG, "lfe: %i\n", s->lfe);
 
312
    av_log(s->avctx, AV_LOG_DEBUG, "predictor history: %i\n",
 
313
           s->predictor_history);
 
314
    av_log(s->avctx, AV_LOG_DEBUG, "header crc: %i\n", s->header_crc);
 
315
    av_log(s->avctx, AV_LOG_DEBUG, "multirate inter: %i\n",
 
316
           s->multirate_inter);
 
317
    av_log(s->avctx, AV_LOG_DEBUG, "version number: %i\n", s->version);
 
318
    av_log(s->avctx, AV_LOG_DEBUG, "copy history: %i\n", s->copy_history);
 
319
    av_log(s->avctx, AV_LOG_DEBUG,
 
320
           "source pcm resolution: %i (%i bits/sample)\n",
 
321
           s->source_pcm_res, dca_bits_per_sample[s->source_pcm_res]);
 
322
    av_log(s->avctx, AV_LOG_DEBUG, "front sum: %i\n", s->front_sum);
 
323
    av_log(s->avctx, AV_LOG_DEBUG, "surround sum: %i\n", s->surround_sum);
 
324
    av_log(s->avctx, AV_LOG_DEBUG, "dialog norm: %i\n", s->dialog_norm);
 
325
    av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
326
#endif
 
327
 
 
328
    /* Primary audio coding header */
 
329
    s->subframes         = get_bits(&s->gb, 4) + 1;
 
330
    s->prim_channels     = get_bits(&s->gb, 3) + 1;
 
331
 
 
332
 
 
333
    for (i = 0; i < s->prim_channels; i++) {
 
334
        s->subband_activity[i] = get_bits(&s->gb, 5) + 2;
 
335
        if (s->subband_activity[i] > DCA_SUBBANDS)
 
336
            s->subband_activity[i] = DCA_SUBBANDS;
 
337
    }
 
338
    for (i = 0; i < s->prim_channels; i++) {
 
339
        s->vq_start_subband[i] = get_bits(&s->gb, 5) + 1;
 
340
        if (s->vq_start_subband[i] > DCA_SUBBANDS)
 
341
            s->vq_start_subband[i] = DCA_SUBBANDS;
 
342
    }
 
343
    get_array(&s->gb, s->joint_intensity,     s->prim_channels, 3);
 
344
    get_array(&s->gb, s->transient_huffman,   s->prim_channels, 2);
 
345
    get_array(&s->gb, s->scalefactor_huffman, s->prim_channels, 3);
 
346
    get_array(&s->gb, s->bitalloc_huffman,    s->prim_channels, 3);
 
347
 
 
348
    /* Get codebooks quantization indexes */
 
349
    memset(s->quant_index_huffman, 0, sizeof(s->quant_index_huffman));
 
350
    for (j = 1; j < 11; j++)
 
351
        for (i = 0; i < s->prim_channels; i++)
 
352
            s->quant_index_huffman[i][j] = get_bits(&s->gb, bitlen[j]);
 
353
 
 
354
    /* Get scale factor adjustment */
 
355
    for (j = 0; j < 11; j++)
 
356
        for (i = 0; i < s->prim_channels; i++)
 
357
            s->scalefactor_adj[i][j] = 1;
 
358
 
 
359
    for (j = 1; j < 11; j++)
 
360
        for (i = 0; i < s->prim_channels; i++)
 
361
            if (s->quant_index_huffman[i][j] < thr[j])
 
362
                s->scalefactor_adj[i][j] = adj_table[get_bits(&s->gb, 2)];
 
363
 
 
364
    if (s->crc_present) {
 
365
        /* Audio header CRC check */
 
366
        get_bits(&s->gb, 16);
 
367
    }
 
368
 
 
369
    s->current_subframe = 0;
 
370
    s->current_subsubframe = 0;
 
371
 
 
372
#ifdef TRACE
 
373
    av_log(s->avctx, AV_LOG_DEBUG, "subframes: %i\n", s->subframes);
 
374
    av_log(s->avctx, AV_LOG_DEBUG, "prim channels: %i\n", s->prim_channels);
 
375
    for(i = 0; i < s->prim_channels; i++){
 
376
        av_log(s->avctx, AV_LOG_DEBUG, "subband activity: %i\n", s->subband_activity[i]);
 
377
        av_log(s->avctx, AV_LOG_DEBUG, "vq start subband: %i\n", s->vq_start_subband[i]);
 
378
        av_log(s->avctx, AV_LOG_DEBUG, "joint intensity: %i\n", s->joint_intensity[i]);
 
379
        av_log(s->avctx, AV_LOG_DEBUG, "transient mode codebook: %i\n", s->transient_huffman[i]);
 
380
        av_log(s->avctx, AV_LOG_DEBUG, "scale factor codebook: %i\n", s->scalefactor_huffman[i]);
 
381
        av_log(s->avctx, AV_LOG_DEBUG, "bit allocation quantizer: %i\n", s->bitalloc_huffman[i]);
 
382
        av_log(s->avctx, AV_LOG_DEBUG, "quant index huff:");
 
383
        for (j = 0; j < 11; j++)
 
384
            av_log(s->avctx, AV_LOG_DEBUG, " %i",
 
385
                   s->quant_index_huffman[i][j]);
 
386
        av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
387
        av_log(s->avctx, AV_LOG_DEBUG, "scalefac adj:");
 
388
        for (j = 0; j < 11; j++)
 
389
            av_log(s->avctx, AV_LOG_DEBUG, " %1.3f", s->scalefactor_adj[i][j]);
 
390
        av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
391
    }
 
392
#endif
 
393
 
 
394
    return 0;
 
395
}
 
396
 
 
397
 
 
398
static inline int get_scale(GetBitContext *gb, int level, int index, int value)
 
399
{
 
400
   if (level < 5) {
 
401
       /* huffman encoded */
 
402
       value += get_bitalloc(gb, &dca_scalefactor, index);
 
403
   } else if(level < 8)
 
404
       value = get_bits(gb, level + 1);
 
405
   return value;
 
406
}
 
407
 
 
408
static int dca_subframe_header(DCAContext * s)
 
409
{
 
410
    /* Primary audio coding side information */
 
411
    int j, k;
 
412
 
 
413
    s->subsubframes = get_bits(&s->gb, 2) + 1;
 
414
    s->partial_samples = get_bits(&s->gb, 3);
 
415
    for (j = 0; j < s->prim_channels; j++) {
 
416
        for (k = 0; k < s->subband_activity[j]; k++)
 
417
            s->prediction_mode[j][k] = get_bits(&s->gb, 1);
 
418
    }
 
419
 
 
420
    /* Get prediction codebook */
 
421
    for (j = 0; j < s->prim_channels; j++) {
 
422
        for (k = 0; k < s->subband_activity[j]; k++) {
 
423
            if (s->prediction_mode[j][k] > 0) {
 
424
                /* (Prediction coefficient VQ address) */
 
425
                s->prediction_vq[j][k] = get_bits(&s->gb, 12);
 
426
            }
 
427
        }
 
428
    }
 
429
 
 
430
    /* Bit allocation index */
 
431
    for (j = 0; j < s->prim_channels; j++) {
 
432
        for (k = 0; k < s->vq_start_subband[j]; k++) {
 
433
            if (s->bitalloc_huffman[j] == 6)
 
434
                s->bitalloc[j][k] = get_bits(&s->gb, 5);
 
435
            else if (s->bitalloc_huffman[j] == 5)
 
436
                s->bitalloc[j][k] = get_bits(&s->gb, 4);
 
437
            else {
 
438
                s->bitalloc[j][k] =
 
439
                    get_bitalloc(&s->gb, &dca_bitalloc_index, j);
 
440
            }
 
441
 
 
442
            if (s->bitalloc[j][k] > 26) {
 
443
//                 av_log(s->avctx,AV_LOG_DEBUG,"bitalloc index [%i][%i] too big (%i)\n",
 
444
//                          j, k, s->bitalloc[j][k]);
 
445
                return -1;
 
446
            }
 
447
        }
 
448
    }
 
449
 
 
450
    /* Transition mode */
 
451
    for (j = 0; j < s->prim_channels; j++) {
 
452
        for (k = 0; k < s->subband_activity[j]; k++) {
 
453
            s->transition_mode[j][k] = 0;
 
454
            if (s->subsubframes > 1 &&
 
455
                k < s->vq_start_subband[j] && s->bitalloc[j][k] > 0) {
 
456
                s->transition_mode[j][k] =
 
457
                    get_bitalloc(&s->gb, &dca_tmode, s->transient_huffman[j]);
 
458
            }
 
459
        }
 
460
    }
 
461
 
 
462
    for (j = 0; j < s->prim_channels; j++) {
 
463
        uint32_t *scale_table;
 
464
        int scale_sum;
 
465
 
 
466
        memset(s->scale_factor[j], 0, s->subband_activity[j] * sizeof(s->scale_factor[0][0][0]) * 2);
 
467
 
 
468
        if (s->scalefactor_huffman[j] == 6)
 
469
            scale_table = (uint32_t *) scale_factor_quant7;
 
470
        else
 
471
            scale_table = (uint32_t *) scale_factor_quant6;
 
472
 
 
473
        /* When huffman coded, only the difference is encoded */
 
474
        scale_sum = 0;
 
475
 
 
476
        for (k = 0; k < s->subband_activity[j]; k++) {
 
477
            if (k >= s->vq_start_subband[j] || s->bitalloc[j][k] > 0) {
 
478
                scale_sum = get_scale(&s->gb, s->scalefactor_huffman[j], j, scale_sum);
 
479
                s->scale_factor[j][k][0] = scale_table[scale_sum];
 
480
            }
 
481
 
 
482
            if (k < s->vq_start_subband[j] && s->transition_mode[j][k]) {
 
483
                /* Get second scale factor */
 
484
                scale_sum = get_scale(&s->gb, s->scalefactor_huffman[j], j, scale_sum);
 
485
                s->scale_factor[j][k][1] = scale_table[scale_sum];
 
486
            }
 
487
        }
 
488
    }
 
489
 
 
490
    /* Joint subband scale factor codebook select */
 
491
    for (j = 0; j < s->prim_channels; j++) {
 
492
        /* Transmitted only if joint subband coding enabled */
 
493
        if (s->joint_intensity[j] > 0)
 
494
            s->joint_huff[j] = get_bits(&s->gb, 3);
 
495
    }
 
496
 
 
497
    /* Scale factors for joint subband coding */
 
498
    for (j = 0; j < s->prim_channels; j++) {
 
499
        int source_channel;
 
500
 
 
501
        /* Transmitted only if joint subband coding enabled */
 
502
        if (s->joint_intensity[j] > 0) {
 
503
            int scale = 0;
 
504
            source_channel = s->joint_intensity[j] - 1;
 
505
 
 
506
            /* When huffman coded, only the difference is encoded
 
507
             * (is this valid as well for joint scales ???) */
 
508
 
 
509
            for (k = s->subband_activity[j]; k < s->subband_activity[source_channel]; k++) {
 
510
                scale = get_scale(&s->gb, s->joint_huff[j], j, 0);
 
511
                scale += 64;    /* bias */
 
512
                s->joint_scale_factor[j][k] = scale;    /*joint_scale_table[scale]; */
 
513
            }
 
514
 
 
515
            if (!s->debug_flag & 0x02) {
 
516
                av_log(s->avctx, AV_LOG_DEBUG,
 
517
                       "Joint stereo coding not supported\n");
 
518
                s->debug_flag |= 0x02;
 
519
            }
 
520
        }
 
521
    }
 
522
 
 
523
    /* Stereo downmix coefficients */
 
524
    if (s->prim_channels > 2 && s->downmix) {
 
525
        for (j = 0; j < s->prim_channels; j++) {
 
526
            s->downmix_coef[j][0] = get_bits(&s->gb, 7);
 
527
            s->downmix_coef[j][1] = get_bits(&s->gb, 7);
 
528
        }
 
529
    }
 
530
 
 
531
    /* Dynamic range coefficient */
 
532
    if (s->dynrange)
 
533
        s->dynrange_coef = get_bits(&s->gb, 8);
 
534
 
 
535
    /* Side information CRC check word */
 
536
    if (s->crc_present) {
 
537
        get_bits(&s->gb, 16);
 
538
    }
 
539
 
 
540
    /*
 
541
     * Primary audio data arrays
 
542
     */
 
543
 
 
544
    /* VQ encoded high frequency subbands */
 
545
    for (j = 0; j < s->prim_channels; j++)
 
546
        for (k = s->vq_start_subband[j]; k < s->subband_activity[j]; k++)
 
547
            /* 1 vector -> 32 samples */
 
548
            s->high_freq_vq[j][k] = get_bits(&s->gb, 10);
 
549
 
 
550
    /* Low frequency effect data */
 
551
    if (s->lfe) {
 
552
        /* LFE samples */
 
553
        int lfe_samples = 2 * s->lfe * s->subsubframes;
 
554
        float lfe_scale;
 
555
 
 
556
        for (j = lfe_samples; j < lfe_samples * 2; j++) {
 
557
            /* Signed 8 bits int */
 
558
            s->lfe_data[j] = get_sbits(&s->gb, 8);
 
559
        }
 
560
 
 
561
        /* Scale factor index */
 
562
        s->lfe_scale_factor = scale_factor_quant7[get_bits(&s->gb, 8)];
 
563
 
 
564
        /* Quantization step size * scale factor */
 
565
        lfe_scale = 0.035 * s->lfe_scale_factor;
 
566
 
 
567
        for (j = lfe_samples; j < lfe_samples * 2; j++)
 
568
            s->lfe_data[j] *= lfe_scale;
 
569
    }
 
570
 
 
571
#ifdef TRACE
 
572
    av_log(s->avctx, AV_LOG_DEBUG, "subsubframes: %i\n", s->subsubframes);
 
573
    av_log(s->avctx, AV_LOG_DEBUG, "partial samples: %i\n",
 
574
           s->partial_samples);
 
575
    for (j = 0; j < s->prim_channels; j++) {
 
576
        av_log(s->avctx, AV_LOG_DEBUG, "prediction mode:");
 
577
        for (k = 0; k < s->subband_activity[j]; k++)
 
578
            av_log(s->avctx, AV_LOG_DEBUG, " %i", s->prediction_mode[j][k]);
 
579
        av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
580
    }
 
581
    for (j = 0; j < s->prim_channels; j++) {
 
582
        for (k = 0; k < s->subband_activity[j]; k++)
 
583
                av_log(s->avctx, AV_LOG_DEBUG,
 
584
                       "prediction coefs: %f, %f, %f, %f\n",
 
585
                       (float) adpcm_vb[s->prediction_vq[j][k]][0] / 8192,
 
586
                       (float) adpcm_vb[s->prediction_vq[j][k]][1] / 8192,
 
587
                       (float) adpcm_vb[s->prediction_vq[j][k]][2] / 8192,
 
588
                       (float) adpcm_vb[s->prediction_vq[j][k]][3] / 8192);
 
589
    }
 
590
    for (j = 0; j < s->prim_channels; j++) {
 
591
        av_log(s->avctx, AV_LOG_DEBUG, "bitalloc index: ");
 
592
        for (k = 0; k < s->vq_start_subband[j]; k++)
 
593
            av_log(s->avctx, AV_LOG_DEBUG, "%2.2i ", s->bitalloc[j][k]);
 
594
        av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
595
    }
 
596
    for (j = 0; j < s->prim_channels; j++) {
 
597
        av_log(s->avctx, AV_LOG_DEBUG, "Transition mode:");
 
598
        for (k = 0; k < s->subband_activity[j]; k++)
 
599
            av_log(s->avctx, AV_LOG_DEBUG, " %i", s->transition_mode[j][k]);
 
600
        av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
601
    }
 
602
    for (j = 0; j < s->prim_channels; j++) {
 
603
        av_log(s->avctx, AV_LOG_DEBUG, "Scale factor:");
 
604
        for (k = 0; k < s->subband_activity[j]; k++) {
 
605
            if (k >= s->vq_start_subband[j] || s->bitalloc[j][k] > 0)
 
606
                av_log(s->avctx, AV_LOG_DEBUG, " %i", s->scale_factor[j][k][0]);
 
607
            if (k < s->vq_start_subband[j] && s->transition_mode[j][k])
 
608
                av_log(s->avctx, AV_LOG_DEBUG, " %i(t)", s->scale_factor[j][k][1]);
 
609
        }
 
610
        av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
611
    }
 
612
    for (j = 0; j < s->prim_channels; j++) {
 
613
        if (s->joint_intensity[j] > 0) {
 
614
            av_log(s->avctx, AV_LOG_DEBUG, "Joint scale factor index:\n");
 
615
            for (k = s->subband_activity[j]; k < s->subband_activity[source_channel]; k++)
 
616
                av_log(s->avctx, AV_LOG_DEBUG, " %i", s->joint_scale_factor[j][k]);
 
617
            av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
618
        }
 
619
    }
 
620
    if (s->prim_channels > 2 && s->downmix) {
 
621
        av_log(s->avctx, AV_LOG_DEBUG, "Downmix coeffs:\n");
 
622
        for (j = 0; j < s->prim_channels; j++) {
 
623
            av_log(s->avctx, AV_LOG_DEBUG, "Channel 0,%d = %f\n", j, dca_downmix_coeffs[s->downmix_coef[j][0]]);
 
624
            av_log(s->avctx, AV_LOG_DEBUG, "Channel 1,%d = %f\n", j, dca_downmix_coeffs[s->downmix_coef[j][1]]);
 
625
        }
 
626
        av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
627
    }
 
628
    for (j = 0; j < s->prim_channels; j++)
 
629
        for (k = s->vq_start_subband[j]; k < s->subband_activity[j]; k++)
 
630
            av_log(s->avctx, AV_LOG_DEBUG, "VQ index: %i\n", s->high_freq_vq[j][k]);
 
631
    if(s->lfe){
 
632
        av_log(s->avctx, AV_LOG_DEBUG, "LFE samples:\n");
 
633
        for (j = lfe_samples; j < lfe_samples * 2; j++)
 
634
            av_log(s->avctx, AV_LOG_DEBUG, " %f", s->lfe_data[j]);
 
635
        av_log(s->avctx, AV_LOG_DEBUG, "\n");
 
636
    }
 
637
#endif
 
638
 
 
639
    return 0;
 
640
}
 
641
 
 
642
static void qmf_32_subbands(DCAContext * s, int chans,
 
643
                            float samples_in[32][8], float *samples_out,
 
644
                            float scale, float bias)
 
645
{
 
646
    float *prCoeff;
 
647
    int i, j, k;
 
648
    float praXin[33], *raXin = &praXin[1];
 
649
 
 
650
    float *subband_fir_hist = s->subband_fir_hist[chans];
 
651
    float *subband_fir_hist2 = s->subband_fir_noidea[chans];
 
652
 
 
653
    int chindex = 0, subindex;
 
654
 
 
655
    praXin[0] = 0.0;
 
656
 
 
657
    /* Select filter */
 
658
    if (!s->multirate_inter)    /* Non-perfect reconstruction */
 
659
        prCoeff = (float *) fir_32bands_nonperfect;
 
660
    else                        /* Perfect reconstruction */
 
661
        prCoeff = (float *) fir_32bands_perfect;
 
662
 
 
663
    /* Reconstructed channel sample index */
 
664
    for (subindex = 0; subindex < 8; subindex++) {
 
665
        float t1, t2, sum[16], diff[16];
 
666
 
 
667
        /* Load in one sample from each subband and clear inactive subbands */
 
668
        for (i = 0; i < s->subband_activity[chans]; i++)
 
669
            raXin[i] = samples_in[i][subindex];
 
670
        for (; i < 32; i++)
 
671
            raXin[i] = 0.0;
 
672
 
 
673
        /* Multiply by cosine modulation coefficients and
 
674
         * create temporary arrays SUM and DIFF */
 
675
        for (j = 0, k = 0; k < 16; k++) {
 
676
            t1 = 0.0;
 
677
            t2 = 0.0;
 
678
            for (i = 0; i < 16; i++, j++){
 
679
                t1 += (raXin[2 * i] + raXin[2 * i + 1]) * cos_mod[j];
 
680
                t2 += (raXin[2 * i] + raXin[2 * i - 1]) * cos_mod[j + 256];
 
681
            }
 
682
            sum[k] = t1 + t2;
 
683
            diff[k] = t1 - t2;
 
684
        }
 
685
 
 
686
        j = 512;
 
687
        /* Store history */
 
688
        for (k = 0; k < 16; k++)
 
689
            subband_fir_hist[k] = cos_mod[j++] * sum[k];
 
690
        for (k = 0; k < 16; k++)
 
691
            subband_fir_hist[32-k-1] = cos_mod[j++] * diff[k];
 
692
 
 
693
        /* Multiply by filter coefficients */
 
694
        for (k = 31, i = 0; i < 32; i++, k--)
 
695
            for (j = 0; j < 512; j += 64){
 
696
                subband_fir_hist2[i]    += prCoeff[i+j]  * ( subband_fir_hist[i+j] - subband_fir_hist[j+k]);
 
697
                subband_fir_hist2[i+32] += prCoeff[i+j+32]*(-subband_fir_hist[i+j] - subband_fir_hist[j+k]);
 
698
            }
 
699
 
 
700
        /* Create 32 PCM output samples */
 
701
        for (i = 0; i < 32; i++)
 
702
            samples_out[chindex++] = subband_fir_hist2[i] * scale + bias;
 
703
 
 
704
        /* Update working arrays */
 
705
        memmove(&subband_fir_hist[32], &subband_fir_hist[0], (512 - 32) * sizeof(float));
 
706
        memmove(&subband_fir_hist2[0], &subband_fir_hist2[32], 32 * sizeof(float));
 
707
        memset(&subband_fir_hist2[32], 0, 32 * sizeof(float));
 
708
    }
 
709
}
 
710
 
 
711
static void lfe_interpolation_fir(int decimation_select,
 
712
                                  int num_deci_sample, float *samples_in,
 
713
                                  float *samples_out, float scale,
 
714
                                  float bias)
 
715
{
 
716
    /* samples_in: An array holding decimated samples.
 
717
     *   Samples in current subframe starts from samples_in[0],
 
718
     *   while samples_in[-1], samples_in[-2], ..., stores samples
 
719
     *   from last subframe as history.
 
720
     *
 
721
     * samples_out: An array holding interpolated samples
 
722
     */
 
723
 
 
724
    int decifactor, k, j;
 
725
    const float *prCoeff;
 
726
 
 
727
    int interp_index = 0;       /* Index to the interpolated samples */
 
728
    int deciindex;
 
729
 
 
730
    /* Select decimation filter */
 
731
    if (decimation_select == 1) {
 
732
        decifactor = 128;
 
733
        prCoeff = lfe_fir_128;
 
734
    } else {
 
735
        decifactor = 64;
 
736
        prCoeff = lfe_fir_64;
 
737
    }
 
738
    /* Interpolation */
 
739
    for (deciindex = 0; deciindex < num_deci_sample; deciindex++) {
 
740
        /* One decimated sample generates decifactor interpolated ones */
 
741
        for (k = 0; k < decifactor; k++) {
 
742
            float rTmp = 0.0;
 
743
            //FIXME the coeffs are symetric, fix that
 
744
            for (j = 0; j < 512 / decifactor; j++)
 
745
                rTmp += samples_in[deciindex - j] * prCoeff[k + j * decifactor];
 
746
            samples_out[interp_index++] = rTmp / scale + bias;
 
747
        }
 
748
    }
 
749
}
 
750
 
 
751
/* downmixing routines */
 
752
#define MIX_REAR1(samples, si1) \
 
753
     samples[i] += samples[si1]; \
 
754
     samples[i+256] += samples[si1];
 
755
 
 
756
#define MIX_REAR2(samples, si1, si2) \
 
757
     samples[i] += samples[si1]; \
 
758
     samples[i+256] += samples[si2];
 
759
 
 
760
#define MIX_FRONT3(samples) \
 
761
    t = samples[i]; \
 
762
    samples[i] += samples[i+256]; \
 
763
    samples[i+256] = samples[i+512] + t;
 
764
 
 
765
#define DOWNMIX_TO_STEREO(op1, op2) \
 
766
    for(i = 0; i < 256; i++){ \
 
767
        op1 \
 
768
        op2 \
 
769
    }
 
770
 
 
771
static void dca_downmix(float *samples, int srcfmt)
 
772
{
 
773
    int i;
 
774
    float t;
 
775
 
 
776
    switch (srcfmt) {
 
777
    case DCA_MONO:
 
778
    case DCA_CHANNEL:
 
779
    case DCA_STEREO_TOTAL:
 
780
    case DCA_STEREO_SUMDIFF:
 
781
    case DCA_4F2R:
 
782
        av_log(NULL, 0, "Not implemented!\n");
 
783
        break;
 
784
    case DCA_STEREO:
 
785
        break;
 
786
    case DCA_3F:
 
787
        DOWNMIX_TO_STEREO(MIX_FRONT3(samples),);
 
788
        break;
 
789
    case DCA_2F1R:
 
790
        DOWNMIX_TO_STEREO(MIX_REAR1(samples, i + 512),);
 
791
        break;
 
792
    case DCA_3F1R:
 
793
        DOWNMIX_TO_STEREO(MIX_FRONT3(samples),
 
794
                          MIX_REAR1(samples, i + 768));
 
795
        break;
 
796
    case DCA_2F2R:
 
797
        DOWNMIX_TO_STEREO(MIX_REAR2(samples, i + 512, i + 768),);
 
798
        break;
 
799
    case DCA_3F2R:
 
800
        DOWNMIX_TO_STEREO(MIX_FRONT3(samples),
 
801
                          MIX_REAR2(samples, i + 768, i + 1024));
 
802
        break;
 
803
    }
 
804
}
 
805
 
 
806
 
 
807
/* Very compact version of the block code decoder that does not use table
 
808
 * look-up but is slightly slower */
 
809
static int decode_blockcode(int code, int levels, int *values)
 
810
{
 
811
    int i;
 
812
    int offset = (levels - 1) >> 1;
 
813
 
 
814
    for (i = 0; i < 4; i++) {
 
815
        values[i] = (code % levels) - offset;
 
816
        code /= levels;
 
817
    }
 
818
 
 
819
    if (code == 0)
 
820
        return 0;
 
821
    else {
 
822
        av_log(NULL, AV_LOG_ERROR, "ERROR: block code look-up failed\n");
 
823
        return -1;
 
824
    }
 
825
}
 
826
 
 
827
static const uint8_t abits_sizes[7] = { 7, 10, 12, 13, 15, 17, 19 };
 
828
static const uint8_t abits_levels[7] = { 3, 5, 7, 9, 13, 17, 25 };
 
829
 
 
830
static int dca_subsubframe(DCAContext * s)
 
831
{
 
832
    int k, l;
 
833
    int subsubframe = s->current_subsubframe;
 
834
 
 
835
    float *quant_step_table;
 
836
 
 
837
    /* FIXME */
 
838
    float subband_samples[DCA_PRIM_CHANNELS_MAX][DCA_SUBBANDS][8];
 
839
 
 
840
    /*
 
841
     * Audio data
 
842
     */
 
843
 
 
844
    /* Select quantization step size table */
 
845
    if (s->bit_rate == 0x1f)
 
846
        quant_step_table = (float *) lossless_quant_d;
 
847
    else
 
848
        quant_step_table = (float *) lossy_quant_d;
 
849
 
 
850
    for (k = 0; k < s->prim_channels; k++) {
 
851
        for (l = 0; l < s->vq_start_subband[k]; l++) {
 
852
            int m;
 
853
 
 
854
            /* Select the mid-tread linear quantizer */
 
855
            int abits = s->bitalloc[k][l];
 
856
 
 
857
            float quant_step_size = quant_step_table[abits];
 
858
            float rscale;
 
859
 
 
860
            /*
 
861
             * Determine quantization index code book and its type
 
862
             */
 
863
 
 
864
            /* Select quantization index code book */
 
865
            int sel = s->quant_index_huffman[k][abits];
 
866
 
 
867
            /*
 
868
             * Extract bits from the bit stream
 
869
             */
 
870
            if(!abits){
 
871
                memset(subband_samples[k][l], 0, 8 * sizeof(subband_samples[0][0][0]));
 
872
            }else if(abits >= 11 || !dca_smpl_bitalloc[abits].vlc[sel].table){
 
873
                if(abits <= 7){
 
874
                    /* Block code */
 
875
                    int block_code1, block_code2, size, levels;
 
876
                    int block[8];
 
877
 
 
878
                    size = abits_sizes[abits-1];
 
879
                    levels = abits_levels[abits-1];
 
880
 
 
881
                    block_code1 = get_bits(&s->gb, size);
 
882
                    /* FIXME Should test return value */
 
883
                    decode_blockcode(block_code1, levels, block);
 
884
                    block_code2 = get_bits(&s->gb, size);
 
885
                    decode_blockcode(block_code2, levels, &block[4]);
 
886
                    for (m = 0; m < 8; m++)
 
887
                        subband_samples[k][l][m] = block[m];
 
888
                }else{
 
889
                    /* no coding */
 
890
                    for (m = 0; m < 8; m++)
 
891
                        subband_samples[k][l][m] = get_sbits(&s->gb, abits - 3);
 
892
                }
 
893
            }else{
 
894
                /* Huffman coded */
 
895
                for (m = 0; m < 8; m++)
 
896
                    subband_samples[k][l][m] = get_bitalloc(&s->gb, &dca_smpl_bitalloc[abits], sel);
 
897
            }
 
898
 
 
899
            /* Deal with transients */
 
900
            if (s->transition_mode[k][l] &&
 
901
                subsubframe >= s->transition_mode[k][l])
 
902
                rscale = quant_step_size * s->scale_factor[k][l][1];
 
903
            else
 
904
                rscale = quant_step_size * s->scale_factor[k][l][0];
 
905
 
 
906
            rscale *= s->scalefactor_adj[k][sel];
 
907
 
 
908
            for (m = 0; m < 8; m++)
 
909
                subband_samples[k][l][m] *= rscale;
 
910
 
 
911
            /*
 
912
             * Inverse ADPCM if in prediction mode
 
913
             */
 
914
            if (s->prediction_mode[k][l]) {
 
915
                int n;
 
916
                for (m = 0; m < 8; m++) {
 
917
                    for (n = 1; n <= 4; n++)
 
918
                        if (m >= n)
 
919
                            subband_samples[k][l][m] +=
 
920
                                (adpcm_vb[s->prediction_vq[k][l]][n - 1] *
 
921
                                 subband_samples[k][l][m - n] / 8192);
 
922
                        else if (s->predictor_history)
 
923
                            subband_samples[k][l][m] +=
 
924
                                (adpcm_vb[s->prediction_vq[k][l]][n - 1] *
 
925
                                 s->subband_samples_hist[k][l][m - n +
 
926
                                                               4] / 8192);
 
927
                }
 
928
            }
 
929
        }
 
930
 
 
931
        /*
 
932
         * Decode VQ encoded high frequencies
 
933
         */
 
934
        for (l = s->vq_start_subband[k]; l < s->subband_activity[k]; l++) {
 
935
            /* 1 vector -> 32 samples but we only need the 8 samples
 
936
             * for this subsubframe. */
 
937
            int m;
 
938
 
 
939
            if (!s->debug_flag & 0x01) {
 
940
                av_log(s->avctx, AV_LOG_DEBUG, "Stream with high frequencies VQ coding\n");
 
941
                s->debug_flag |= 0x01;
 
942
            }
 
943
 
 
944
            for (m = 0; m < 8; m++) {
 
945
                subband_samples[k][l][m] =
 
946
                    high_freq_vq[s->high_freq_vq[k][l]][subsubframe * 8 +
 
947
                                                        m]
 
948
                    * (float) s->scale_factor[k][l][0] / 16.0;
 
949
            }
 
950
        }
 
951
    }
 
952
 
 
953
    /* Check for DSYNC after subsubframe */
 
954
    if (s->aspf || subsubframe == s->subsubframes - 1) {
 
955
        if (0xFFFF == get_bits(&s->gb, 16)) {   /* 0xFFFF */
 
956
#ifdef TRACE
 
957
            av_log(s->avctx, AV_LOG_DEBUG, "Got subframe DSYNC\n");
 
958
#endif
 
959
        } else {
 
960
            av_log(s->avctx, AV_LOG_ERROR, "Didn't get subframe DSYNC\n");
 
961
        }
 
962
    }
 
963
 
 
964
    /* Backup predictor history for adpcm */
 
965
    for (k = 0; k < s->prim_channels; k++)
 
966
        for (l = 0; l < s->vq_start_subband[k]; l++)
 
967
            memcpy(s->subband_samples_hist[k][l], &subband_samples[k][l][4],
 
968
                        4 * sizeof(subband_samples[0][0][0]));
 
969
 
 
970
    /* 32 subbands QMF */
 
971
    for (k = 0; k < s->prim_channels; k++) {
 
972
/*        static float pcm_to_double[8] =
 
973
            {32768.0, 32768.0, 524288.0, 524288.0, 0, 8388608.0, 8388608.0};*/
 
974
         qmf_32_subbands(s, k, subband_samples[k], &s->samples[256 * k],
 
975
                            2.0 / 3 /*pcm_to_double[s->source_pcm_res] */ ,
 
976
                            0 /*s->bias */ );
 
977
    }
 
978
 
 
979
    /* Down mixing */
 
980
 
 
981
    if (s->prim_channels > dca_channels[s->output & DCA_CHANNEL_MASK]) {
 
982
        dca_downmix(s->samples, s->amode);
 
983
    }
 
984
 
 
985
    /* Generate LFE samples for this subsubframe FIXME!!! */
 
986
    if (s->output & DCA_LFE) {
 
987
        int lfe_samples = 2 * s->lfe * s->subsubframes;
 
988
        int i_channels = dca_channels[s->output & DCA_CHANNEL_MASK];
 
989
 
 
990
        lfe_interpolation_fir(s->lfe, 2 * s->lfe,
 
991
                              s->lfe_data + lfe_samples +
 
992
                              2 * s->lfe * subsubframe,
 
993
                              &s->samples[256 * i_channels],
 
994
                              8388608.0, s->bias);
 
995
        /* Outputs 20bits pcm samples */
 
996
    }
 
997
 
 
998
    return 0;
 
999
}
 
1000
 
 
1001
 
 
1002
static int dca_subframe_footer(DCAContext * s)
 
1003
{
 
1004
    int aux_data_count = 0, i;
 
1005
    int lfe_samples;
 
1006
 
 
1007
    /*
 
1008
     * Unpack optional information
 
1009
     */
 
1010
 
 
1011
    if (s->timestamp)
 
1012
        get_bits(&s->gb, 32);
 
1013
 
 
1014
    if (s->aux_data)
 
1015
        aux_data_count = get_bits(&s->gb, 6);
 
1016
 
 
1017
    for (i = 0; i < aux_data_count; i++)
 
1018
        get_bits(&s->gb, 8);
 
1019
 
 
1020
    if (s->crc_present && (s->downmix || s->dynrange))
 
1021
        get_bits(&s->gb, 16);
 
1022
 
 
1023
    lfe_samples = 2 * s->lfe * s->subsubframes;
 
1024
    for (i = 0; i < lfe_samples; i++) {
 
1025
        s->lfe_data[i] = s->lfe_data[i + lfe_samples];
 
1026
    }
 
1027
 
 
1028
    return 0;
 
1029
}
 
1030
 
 
1031
/**
 
1032
 * Decode a dca frame block
 
1033
 *
 
1034
 * @param s     pointer to the DCAContext
 
1035
 */
 
1036
 
 
1037
static int dca_decode_block(DCAContext * s)
 
1038
{
 
1039
 
 
1040
    /* Sanity check */
 
1041
    if (s->current_subframe >= s->subframes) {
 
1042
        av_log(s->avctx, AV_LOG_DEBUG, "check failed: %i>%i",
 
1043
               s->current_subframe, s->subframes);
 
1044
        return -1;
 
1045
    }
 
1046
 
 
1047
    if (!s->current_subsubframe) {
 
1048
#ifdef TRACE
 
1049
        av_log(s->avctx, AV_LOG_DEBUG, "DSYNC dca_subframe_header\n");
 
1050
#endif
 
1051
        /* Read subframe header */
 
1052
        if (dca_subframe_header(s))
 
1053
            return -1;
 
1054
    }
 
1055
 
 
1056
    /* Read subsubframe */
 
1057
#ifdef TRACE
 
1058
    av_log(s->avctx, AV_LOG_DEBUG, "DSYNC dca_subsubframe\n");
 
1059
#endif
 
1060
    if (dca_subsubframe(s))
 
1061
        return -1;
 
1062
 
 
1063
    /* Update state */
 
1064
    s->current_subsubframe++;
 
1065
    if (s->current_subsubframe >= s->subsubframes) {
 
1066
        s->current_subsubframe = 0;
 
1067
        s->current_subframe++;
 
1068
    }
 
1069
    if (s->current_subframe >= s->subframes) {
 
1070
#ifdef TRACE
 
1071
        av_log(s->avctx, AV_LOG_DEBUG, "DSYNC dca_subframe_footer\n");
 
1072
#endif
 
1073
        /* Read subframe footer */
 
1074
        if (dca_subframe_footer(s))
 
1075
            return -1;
 
1076
    }
 
1077
 
 
1078
    return 0;
 
1079
}
 
1080
 
 
1081
/**
 
1082
 * Convert bitstream to one representation based on sync marker
 
1083
 */
 
1084
static int dca_convert_bitstream(uint8_t * src, int src_size, uint8_t * dst,
 
1085
                          int max_size)
 
1086
{
 
1087
    uint32_t mrk;
 
1088
    int i, tmp;
 
1089
    uint16_t *ssrc = (uint16_t *) src, *sdst = (uint16_t *) dst;
 
1090
    PutBitContext pb;
 
1091
 
 
1092
    mrk = AV_RB32(src);
 
1093
    switch (mrk) {
 
1094
    case DCA_MARKER_RAW_BE:
 
1095
        memcpy(dst, src, FFMIN(src_size, max_size));
 
1096
        return FFMIN(src_size, max_size);
 
1097
    case DCA_MARKER_RAW_LE:
 
1098
        for (i = 0; i < (FFMIN(src_size, max_size) + 1) >> 1; i++)
 
1099
            *sdst++ = bswap_16(*ssrc++);
 
1100
        return FFMIN(src_size, max_size);
 
1101
    case DCA_MARKER_14B_BE:
 
1102
    case DCA_MARKER_14B_LE:
 
1103
        init_put_bits(&pb, dst, max_size);
 
1104
        for (i = 0; i < (src_size + 1) >> 1; i++, src += 2) {
 
1105
            tmp = ((mrk == DCA_MARKER_14B_BE) ? AV_RB16(src) : AV_RL16(src)) & 0x3FFF;
 
1106
            put_bits(&pb, 14, tmp);
 
1107
        }
 
1108
        flush_put_bits(&pb);
 
1109
        return (put_bits_count(&pb) + 7) >> 3;
 
1110
    default:
 
1111
        return -1;
 
1112
    }
 
1113
}
 
1114
 
 
1115
/**
 
1116
 * Main frame decoding function
 
1117
 * FIXME add arguments
 
1118
 */
 
1119
static int dca_decode_frame(AVCodecContext * avctx,
 
1120
                            void *data, int *data_size,
 
1121
                            uint8_t * buf, int buf_size)
 
1122
{
 
1123
 
 
1124
    int i, j, k;
 
1125
    int16_t *samples = data;
 
1126
    DCAContext *s = avctx->priv_data;
 
1127
    int channels;
 
1128
 
 
1129
 
 
1130
    s->dca_buffer_size = dca_convert_bitstream(buf, buf_size, s->dca_buffer, DCA_MAX_FRAME_SIZE);
 
1131
    if (s->dca_buffer_size == -1) {
 
1132
        av_log(avctx, AV_LOG_ERROR, "Not a DCA frame\n");
 
1133
        return -1;
 
1134
    }
 
1135
 
 
1136
    init_get_bits(&s->gb, s->dca_buffer, s->dca_buffer_size * 8);
 
1137
    if (dca_parse_frame_header(s) < 0) {
 
1138
        //seems like the frame is corrupt, try with the next one
 
1139
        return buf_size;
 
1140
    }
 
1141
    //set AVCodec values with parsed data
 
1142
    avctx->sample_rate = s->sample_rate;
 
1143
    avctx->channels = 2; //FIXME
 
1144
    avctx->bit_rate = s->bit_rate;
 
1145
 
 
1146
    channels = dca_channels[s->output];
 
1147
    if(*data_size < (s->sample_blocks / 8) * 256 * sizeof(int16_t) * channels)
 
1148
        return -1;
 
1149
    *data_size = 0;
 
1150
    for (i = 0; i < (s->sample_blocks / 8); i++) {
 
1151
        dca_decode_block(s);
 
1152
        s->dsp.float_to_int16(s->tsamples, s->samples, 256 * channels);
 
1153
        /* interleave samples */
 
1154
        for (j = 0; j < 256; j++) {
 
1155
            for (k = 0; k < channels; k++)
 
1156
                samples[k] = s->tsamples[j + k * 256];
 
1157
            samples += channels;
 
1158
        }
 
1159
        *data_size += 256 * sizeof(int16_t) * channels;
 
1160
    }
 
1161
 
 
1162
    return buf_size;
 
1163
}
 
1164
 
 
1165
 
 
1166
 
 
1167
/**
 
1168
 * Build the cosine modulation tables for the QMF
 
1169
 *
 
1170
 * @param s     pointer to the DCAContext
 
1171
 */
 
1172
 
 
1173
static void pre_calc_cosmod(DCAContext * s)
 
1174
{
 
1175
    int i, j, k;
 
1176
    static int cosmod_inited = 0;
 
1177
 
 
1178
    if(cosmod_inited) return;
 
1179
    for (j = 0, k = 0; k < 16; k++)
 
1180
        for (i = 0; i < 16; i++)
 
1181
            cos_mod[j++] = cos((2 * i + 1) * (2 * k + 1) * M_PI / 64);
 
1182
 
 
1183
    for (k = 0; k < 16; k++)
 
1184
        for (i = 0; i < 16; i++)
 
1185
            cos_mod[j++] = cos((i) * (2 * k + 1) * M_PI / 32);
 
1186
 
 
1187
    for (k = 0; k < 16; k++)
 
1188
        cos_mod[j++] = 0.25 / (2 * cos((2 * k + 1) * M_PI / 128));
 
1189
 
 
1190
    for (k = 0; k < 16; k++)
 
1191
        cos_mod[j++] = -0.25 / (2.0 * sin((2 * k + 1) * M_PI / 128));
 
1192
 
 
1193
    cosmod_inited = 1;
 
1194
}
 
1195
 
 
1196
 
 
1197
/**
 
1198
 * DCA initialization
 
1199
 *
 
1200
 * @param avctx     pointer to the AVCodecContext
 
1201
 */
 
1202
 
 
1203
static int dca_decode_init(AVCodecContext * avctx)
 
1204
{
 
1205
    DCAContext *s = avctx->priv_data;
 
1206
 
 
1207
    s->avctx = avctx;
 
1208
    dca_init_vlcs();
 
1209
    pre_calc_cosmod(s);
 
1210
 
 
1211
    dsputil_init(&s->dsp, avctx);
 
1212
    return 0;
 
1213
}
 
1214
 
 
1215
 
 
1216
AVCodec dca_decoder = {
 
1217
    .name = "dca",
 
1218
    .type = CODEC_TYPE_AUDIO,
 
1219
    .id = CODEC_ID_DTS,
 
1220
    .priv_data_size = sizeof(DCAContext),
 
1221
    .init = dca_decode_init,
 
1222
    .decode = dca_decode_frame,
 
1223
};
 
1224
 
 
1225
#ifdef CONFIG_DCA_PARSER
 
1226
 
 
1227
typedef struct DCAParseContext {
 
1228
    ParseContext pc;
 
1229
    uint32_t lastmarker;
 
1230
} DCAParseContext;
 
1231
 
 
1232
#define IS_MARKER(state, i, buf, buf_size) \
 
1233
 ((state == DCA_MARKER_14B_LE && (i < buf_size-2) && (buf[i+1] & 0xF0) == 0xF0 && buf[i+2] == 0x07) \
 
1234
 || (state == DCA_MARKER_14B_BE && (i < buf_size-2) && buf[i+1] == 0x07 && (buf[i+2] & 0xF0) == 0xF0) \
 
1235
 || state == DCA_MARKER_RAW_LE || state == DCA_MARKER_RAW_BE)
 
1236
 
 
1237
/**
 
1238
 * finds the end of the current frame in the bitstream.
 
1239
 * @return the position of the first byte of the next frame, or -1
 
1240
 */
 
1241
static int dca_find_frame_end(DCAParseContext * pc1, const uint8_t * buf,
 
1242
                              int buf_size)
 
1243
{
 
1244
    int start_found, i;
 
1245
    uint32_t state;
 
1246
    ParseContext *pc = &pc1->pc;
 
1247
 
 
1248
    start_found = pc->frame_start_found;
 
1249
    state = pc->state;
 
1250
 
 
1251
    i = 0;
 
1252
    if (!start_found) {
 
1253
        for (i = 0; i < buf_size; i++) {
 
1254
            state = (state << 8) | buf[i];
 
1255
            if (IS_MARKER(state, i, buf, buf_size)) {
 
1256
                if (pc1->lastmarker && state == pc1->lastmarker) {
 
1257
                    start_found = 1;
 
1258
                    break;
 
1259
                } else if (!pc1->lastmarker) {
 
1260
                    start_found = 1;
 
1261
                    pc1->lastmarker = state;
 
1262
                    break;
 
1263
                }
 
1264
            }
 
1265
        }
 
1266
    }
 
1267
    if (start_found) {
 
1268
        for (; i < buf_size; i++) {
 
1269
            state = (state << 8) | buf[i];
 
1270
            if (state == pc1->lastmarker && IS_MARKER(state, i, buf, buf_size)) {
 
1271
                pc->frame_start_found = 0;
 
1272
                pc->state = -1;
 
1273
                return i - 3;
 
1274
            }
 
1275
        }
 
1276
    }
 
1277
    pc->frame_start_found = start_found;
 
1278
    pc->state = state;
 
1279
    return END_NOT_FOUND;
 
1280
}
 
1281
 
 
1282
static int dca_parse_init(AVCodecParserContext * s)
 
1283
{
 
1284
    DCAParseContext *pc1 = s->priv_data;
 
1285
 
 
1286
    pc1->lastmarker = 0;
 
1287
    return 0;
 
1288
}
 
1289
 
 
1290
static int dca_parse(AVCodecParserContext * s,
 
1291
                     AVCodecContext * avctx,
 
1292
                     uint8_t ** poutbuf, int *poutbuf_size,
 
1293
                     const uint8_t * buf, int buf_size)
 
1294
{
 
1295
    DCAParseContext *pc1 = s->priv_data;
 
1296
    ParseContext *pc = &pc1->pc;
 
1297
    int next;
 
1298
 
 
1299
    if (s->flags & PARSER_FLAG_COMPLETE_FRAMES) {
 
1300
        next = buf_size;
 
1301
    } else {
 
1302
        next = dca_find_frame_end(pc1, buf, buf_size);
 
1303
 
 
1304
        if (ff_combine_frame(pc, next, (uint8_t **) & buf, &buf_size) < 0) {
 
1305
            *poutbuf = NULL;
 
1306
            *poutbuf_size = 0;
 
1307
            return buf_size;
 
1308
        }
 
1309
    }
 
1310
    *poutbuf = (uint8_t *) buf;
 
1311
    *poutbuf_size = buf_size;
 
1312
    return next;
 
1313
}
 
1314
 
 
1315
AVCodecParser dca_parser = {
 
1316
    {CODEC_ID_DTS},
 
1317
    sizeof(DCAParseContext),
 
1318
    dca_parse_init,
 
1319
    dca_parse,
 
1320
    ff_parse_close,
 
1321
};
 
1322
#endif /* CONFIG_DCA_PARSER */