adpcm.c 43.6 KB
Newer Older
1
/*
2
 * Copyright (c) 2001-2003 The ffmpeg Project
3
 *
4 5 6
 * This file is part of FFmpeg.
 *
 * FFmpeg is free software; you can redistribute it and/or
7 8
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
9
 * version 2.1 of the License, or (at your option) any later version.
10
 *
11
 * FFmpeg is distributed in the hope that it will be useful,
12 13 14 15 16
 * 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
17
 * License along with FFmpeg; if not, write to the Free Software
18
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
19 20
 */
#include "avcodec.h"
21
#include "get_bits.h"
22
#include "put_bits.h"
23
#include "bytestream.h"
24 25
#include "adpcm.h"
#include "adpcm_data.h"
26

Michael Niedermayer's avatar
Michael Niedermayer committed
27
/**
28
 * @file
29
 * ADPCM decoders
30
 * First version by Francois Revol (revol@free.fr)
31
 * Fringe ADPCM codecs (e.g., DK3, DK4, Westwood)
32
 *   by Mike Melanson (melanson@pcisys.net)
33
 * CD-ROM XA ADPCM codec by BERO
34
 * EA ADPCM decoder by Robin Kay (komadori@myrealbox.com)
35
 * EA ADPCM R1/R2/R3 decoder by Peter Ross (pross@xvid.org)
Peter Ross's avatar
Peter Ross committed
36
 * EA IMA EACS decoder by Peter Ross (pross@xvid.org)
Peter Ross's avatar
Peter Ross committed
37
 * EA IMA SEAD decoder by Peter Ross (pross@xvid.org)
38
 * EA ADPCM XAS decoder by Peter Ross (pross@xvid.org)
39
 * MAXIS EA ADPCM decoder by Robert Marston (rmarston@gmail.com)
40
 * THP ADPCM decoder by Marco Gerards (mgerards@xs4all.nl)
41 42 43 44
 *
 * Features and limitations:
 *
 * Reference documents:
45 46 47 48 49 50 51
 * http://wiki.multimedia.cx/index.php?title=Category:ADPCM_Audio_Codecs
 * http://www.pcisys.net/~melanson/codecs/simpleaudio.html [dead]
 * http://www.geocities.com/SiliconValley/8682/aud3.txt [dead]
 * http://openquicktime.sourceforge.net/
 * XAnim sources (xa_codec.c) http://xanim.polter.net/
 * http://www.cs.ucla.edu/~leec/mediabench/applications.html [dead]
 * SoX source code http://sox.sourceforge.net/
52 53
 *
 * CD-ROM XA:
54 55
 * http://ku-www.ss.titech.ac.jp/~yatsushi/xaadpcm.html [dead]
 * vagpack & depack http://homepages.compuserve.de/bITmASTER32/psx-index.html [dead]
56
 * readstr http://www.geocities.co.jp/Playtown/2004/
57 58
 */

59
/* These are for CD-ROM XA ADPCM */
Alex Beregszaszi's avatar
Alex Beregszaszi committed
60
static const int xa_adpcm_table[5][2] = {
61 62 63 64 65
    {   0,   0 },
    {  60,   0 },
    { 115, -52 },
    {  98, -55 },
    { 122, -60 }
66 67
};

Michael Niedermayer's avatar
Michael Niedermayer committed
68
static const int ea_adpcm_table[] = {
69 70 71 72 73
    0,  240,  460,  392,
    0,    0, -208, -220,
    0,    1,    3,    4,
    7,    8,   10,   11,
    0,   -1,   -3,   -4
74 75
};

76
// padded to zero where table size is less then 16
Michael Niedermayer's avatar
Michael Niedermayer committed
77
static const int swf_index_tables[4][16] = {
78 79 80 81 82 83
    /*2*/ { -1, 2 },
    /*3*/ { -1, -1, 2, 4 },
    /*4*/ { -1, -1, -1, -1, 2, 4, 6, 8 },
    /*5*/ { -1, -1, -1, -1, -1, -1, -1, -1, 1, 2, 4, 6, 8, 10, 13, 16 }
};

84 85
/* end of tables */

86
typedef struct ADPCMDecodeContext {
87
    ADPCMChannelStatus status[6];
88
} ADPCMDecodeContext;
89

90
static av_cold int adpcm_decode_init(AVCodecContext * avctx)
91
{
92
    ADPCMDecodeContext *c = avctx->priv_data;
Baptiste Coudurier's avatar
Baptiste Coudurier committed
93
    unsigned int max_channels = 2;
94

95 96 97 98
    switch(avctx->codec->id) {
    case CODEC_ID_ADPCM_EA_R1:
    case CODEC_ID_ADPCM_EA_R2:
    case CODEC_ID_ADPCM_EA_R3:
99
    case CODEC_ID_ADPCM_EA_XAS:
100 101 102 103
        max_channels = 6;
        break;
    }
    if(avctx->channels > max_channels){
104 105 106
        return -1;
    }

107
    switch(avctx->codec->id) {
108
    case CODEC_ID_ADPCM_CT:
109 110
        c->status[0].step = c->status[1].step = 511;
        break;
111 112 113 114 115 116
    case CODEC_ID_ADPCM_IMA_WAV:
        if (avctx->bits_per_coded_sample != 4) {
            av_log(avctx, AV_LOG_ERROR, "Only 4-bit ADPCM IMA WAV files are supported\n");
            return -1;
        }
        break;
Anssi Hannula's avatar
Anssi Hannula committed
117 118 119 120 121 122
    case CODEC_ID_ADPCM_IMA_WS:
        if (avctx->extradata && avctx->extradata_size == 2 * 4) {
            c->status[0].predictor = AV_RL32(avctx->extradata);
            c->status[1].predictor = AV_RL32(avctx->extradata + 4);
        }
        break;
123 124 125
    default:
        break;
    }
126
    avctx->sample_fmt = AV_SAMPLE_FMT_S16;
127 128 129
    return 0;
}

Michael Niedermayer's avatar
Michael Niedermayer committed
130
static inline short adpcm_ima_expand_nibble(ADPCMChannelStatus *c, char nibble, int shift)
131 132 133 134 135
{
    int step_index;
    int predictor;
    int sign, delta, diff, step;

136 137
    step = ff_adpcm_step_table[c->step_index];
    step_index = c->step_index + ff_adpcm_index_table[(unsigned)nibble];
138
    if (step_index < 0) step_index = 0;
139
    else if (step_index > 88) step_index = 88;
140 141 142

    sign = nibble & 8;
    delta = nibble & 7;
143 144 145
    /* perform direct multiplication instead of series of jumps proposed by
     * the reference ADPCM implementation since modern CPUs can do the mults
     * quickly enough */
Michael Niedermayer's avatar
Michael Niedermayer committed
146
    diff = ((2 * delta + 1) * step) >> shift;
Michael Niedermayer's avatar
Michael Niedermayer committed
147 148 149 150
    predictor = c->predictor;
    if (sign) predictor -= diff;
    else predictor += diff;

151
    c->predictor = av_clip_int16(predictor);
Michael Niedermayer's avatar
Michael Niedermayer committed
152 153
    c->step_index = step_index;

154
    return (short)c->predictor;
Michael Niedermayer's avatar
Michael Niedermayer committed
155 156
}

157 158 159 160 161 162
static inline int adpcm_ima_qt_expand_nibble(ADPCMChannelStatus *c, int nibble, int shift)
{
    int step_index;
    int predictor;
    int diff, step;

163 164
    step = ff_adpcm_step_table[c->step_index];
    step_index = c->step_index + ff_adpcm_index_table[nibble];
165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182
    step_index = av_clip(step_index, 0, 88);

    diff = step >> 3;
    if (nibble & 4) diff += step;
    if (nibble & 2) diff += step >> 1;
    if (nibble & 1) diff += step >> 2;

    if (nibble & 8)
        predictor = c->predictor - diff;
    else
        predictor = c->predictor + diff;

    c->predictor = av_clip_int16(predictor);
    c->step_index = step_index;

    return c->predictor;
}

183 184 185 186
static inline short adpcm_ms_expand_nibble(ADPCMChannelStatus *c, char nibble)
{
    int predictor;

187
    predictor = (((c->sample1) * (c->coeff1)) + ((c->sample2) * (c->coeff2))) / 64;
188 189 190
    predictor += (signed)((nibble & 0x08)?(nibble - 0x10):(nibble)) * c->idelta;

    c->sample2 = c->sample1;
191
    c->sample1 = av_clip_int16(predictor);
192
    c->idelta = (ff_adpcm_AdaptationTable[(int)nibble] * c->idelta) >> 8;
193 194
    if (c->idelta < 16) c->idelta = 16;

195
    return c->sample1;
196 197
}

198 199 200 201 202 203 204 205 206 207 208 209
static inline short adpcm_ct_expand_nibble(ADPCMChannelStatus *c, char nibble)
{
    int sign, delta, diff;
    int new_step;

    sign = nibble & 8;
    delta = nibble & 7;
    /* perform direct multiplication instead of series of jumps proposed by
     * the reference ADPCM implementation since modern CPUs can do the mults
     * quickly enough */
    diff = ((2 * delta + 1) * c->step) >> 3;
    /* predictor update is not so trivial: predictor is multiplied on 254/256 before updating */
210 211
    c->predictor = ((c->predictor * 254) >> 8) + (sign ? -diff : diff);
    c->predictor = av_clip_int16(c->predictor);
212
    /* calculate new step and clamp it to range 511..32767 */
213
    new_step = (ff_adpcm_AdaptationTable[nibble & 7] * c->step) >> 8;
214
    c->step = av_clip(new_step, 511, 32767);
215

216
    return (short)c->predictor;
217 218
}

219 220 221 222 223 224 225 226 227
static inline short adpcm_sbpro_expand_nibble(ADPCMChannelStatus *c, char nibble, int size, int shift)
{
    int sign, delta, diff;

    sign = nibble & (1<<(size-1));
    delta = nibble & ((1<<(size-1))-1);
    diff = delta << (7 + c->step + shift);

    /* clamp result */
228
    c->predictor = av_clip(c->predictor + (sign ? -diff : diff), -16384,16256);
229 230 231 232 233 234 235 236 237 238

    /* calculate new step */
    if (delta >= (2*size - 3) && c->step < 3)
        c->step++;
    else if (delta == 0 && c->step > 0)
        c->step--;

    return (short) c->predictor;
}

239 240 241 242 243 244 245
static inline short adpcm_yamaha_expand_nibble(ADPCMChannelStatus *c, unsigned char nibble)
{
    if(!c->step) {
        c->predictor = 0;
        c->step = 127;
    }

246
    c->predictor += (c->step * ff_adpcm_yamaha_difflookup[nibble]) / 8;
247
    c->predictor = av_clip_int16(c->predictor);
248
    c->step = (c->step * ff_adpcm_yamaha_indexscale[nibble]) >> 8;
249
    c->step = av_clip(c->step, 127, 24567);
250 251 252
    return c->predictor;
}

253
static void xa_decode(short *out, const unsigned char *in,
254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276
    ADPCMChannelStatus *left, ADPCMChannelStatus *right, int inc)
{
    int i, j;
    int shift,filter,f0,f1;
    int s_1,s_2;
    int d,s,t;

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

        shift  = 12 - (in[4+i*2] & 15);
        filter = in[4+i*2] >> 4;
        f0 = xa_adpcm_table[filter][0];
        f1 = xa_adpcm_table[filter][1];

        s_1 = left->sample1;
        s_2 = left->sample2;

        for(j=0;j<28;j++) {
            d = in[16+i+j*4];

            t = (signed char)(d<<4)>>4;
            s = ( t<<shift ) + ((s_1*f0 + s_2*f1+32)>>6);
            s_2 = s_1;
277 278 279
            s_1 = av_clip_int16(s);
            *out = s_1;
            out += inc;
280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
        }

        if (inc==2) { /* stereo */
            left->sample1 = s_1;
            left->sample2 = s_2;
            s_1 = right->sample1;
            s_2 = right->sample2;
            out = out + 1 - 28*2;
        }

        shift  = 12 - (in[5+i*2] & 15);
        filter = in[5+i*2] >> 4;

        f0 = xa_adpcm_table[filter][0];
        f1 = xa_adpcm_table[filter][1];

        for(j=0;j<28;j++) {
            d = in[16+i+j*4];

            t = (signed char)d >> 4;
            s = ( t<<shift ) + ((s_1*f0 + s_2*f1+32)>>6);
            s_2 = s_1;
302 303 304
            s_1 = av_clip_int16(s);
            *out = s_1;
            out += inc;
305 306 307 308 309 310 311 312 313 314 315 316 317
        }

        if (inc==2) { /* stereo */
            right->sample1 = s_1;
            right->sample2 = s_2;
            out -= 1;
        } else {
            left->sample1 = s_1;
            left->sample2 = s_2;
        }
    }
}

318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484
/**
 * Get the number of samples that will be decoded from the packet.
 * In one case, this is actually the maximum number of samples possible to
 * decode with the given buf_size.
 *
 * @param[out] coded_samples set to the number of samples as coded in the
 *                           packet, or 0 if the codec does not encode the
 *                           number of samples in each frame.
 */
static int get_nb_samples(AVCodecContext *avctx, const uint8_t *buf,
                          int buf_size, int *coded_samples)
{
    ADPCMDecodeContext *s = avctx->priv_data;
    int nb_samples        = 0;
    int ch                = avctx->channels;
    int has_coded_samples = 0;
    int header_size;

    *coded_samples = 0;

    switch (avctx->codec->id) {
    /* constant, only check buf_size */
    case CODEC_ID_ADPCM_EA_XAS:
        if (buf_size < 76 * ch)
            return 0;
        nb_samples = 128;
        break;
    case CODEC_ID_ADPCM_IMA_QT:
        if (buf_size < 34 * ch)
            return 0;
        nb_samples = 64;
        break;
    /* simple 4-bit adpcm */
    case CODEC_ID_ADPCM_CT:
    case CODEC_ID_ADPCM_IMA_EA_SEAD:
    case CODEC_ID_ADPCM_IMA_WS:
    case CODEC_ID_ADPCM_YAMAHA:
        nb_samples = buf_size * 2 / ch;
        break;
    }
    if (nb_samples)
        return nb_samples;

    /* simple 4-bit adpcm, with header */
    header_size = 0;
    switch (avctx->codec->id) {
        case CODEC_ID_ADPCM_4XM:
        case CODEC_ID_ADPCM_IMA_ISS:     header_size = 4 * ch;      break;
        case CODEC_ID_ADPCM_IMA_AMV:     header_size = 8;           break;
        case CODEC_ID_ADPCM_IMA_SMJPEG:  header_size = 4;           break;
    }
    if (header_size > 0)
        return (buf_size - header_size) * 2 / ch;

    /* more complex formats */
    switch (avctx->codec->id) {
    case CODEC_ID_ADPCM_EA:
        has_coded_samples = 1;
        if (buf_size < 4)
            return 0;
        *coded_samples  = AV_RL32(buf);
        *coded_samples -= *coded_samples % 28;
        nb_samples      = (buf_size - 12) / 30 * 28;
        break;
    case CODEC_ID_ADPCM_IMA_EA_EACS:
        has_coded_samples = 1;
        if (buf_size < 4)
            return 0;
        *coded_samples = AV_RL32(buf);
        nb_samples     = (buf_size - (4 + 8 * ch)) * 2 / ch;
        break;
    case CODEC_ID_ADPCM_EA_MAXIS_XA:
        nb_samples = ((buf_size - ch) / (2 * ch)) * 2 * ch;
        break;
    case CODEC_ID_ADPCM_EA_R1:
    case CODEC_ID_ADPCM_EA_R2:
    case CODEC_ID_ADPCM_EA_R3:
        /* maximum number of samples */
        /* has internal offsets and a per-frame switch to signal raw 16-bit */
        has_coded_samples = 1;
        if (buf_size < 4)
            return 0;
        switch (avctx->codec->id) {
        case CODEC_ID_ADPCM_EA_R1:
            header_size    = 4 + 9 * ch;
            *coded_samples = AV_RL32(buf);
            break;
        case CODEC_ID_ADPCM_EA_R2:
            header_size    = 4 + 5 * ch;
            *coded_samples = AV_RL32(buf);
            break;
        case CODEC_ID_ADPCM_EA_R3:
            header_size    = 4 + 5 * ch;
            *coded_samples = AV_RB32(buf);
            break;
        }
        *coded_samples -= *coded_samples % 28;
        nb_samples      = (buf_size - header_size) * 2 / ch;
        nb_samples     -= nb_samples % 28;
        break;
    case CODEC_ID_ADPCM_IMA_DK3:
        if (avctx->block_align > 0)
            buf_size = FFMIN(buf_size, avctx->block_align);
        nb_samples = ((buf_size - 16) * 8 / 3) / ch;
        break;
    case CODEC_ID_ADPCM_IMA_DK4:
        nb_samples = 1 + (buf_size - 4 * ch) * 2 / ch;
        break;
    case CODEC_ID_ADPCM_IMA_WAV:
        if (avctx->block_align > 0)
            buf_size = FFMIN(buf_size, avctx->block_align);
        nb_samples = 1 + (buf_size - 4 * ch) / (4 * ch) * 8;
        break;
    case CODEC_ID_ADPCM_MS:
        if (avctx->block_align > 0)
            buf_size = FFMIN(buf_size, avctx->block_align);
        nb_samples = 2 + (buf_size - 7 * ch) * 2 / ch;
        break;
    case CODEC_ID_ADPCM_SBPRO_2:
    case CODEC_ID_ADPCM_SBPRO_3:
    case CODEC_ID_ADPCM_SBPRO_4:
    {
        int samples_per_byte;
        switch (avctx->codec->id) {
        case CODEC_ID_ADPCM_SBPRO_2: samples_per_byte = 4; break;
        case CODEC_ID_ADPCM_SBPRO_3: samples_per_byte = 3; break;
        case CODEC_ID_ADPCM_SBPRO_4: samples_per_byte = 2; break;
        }
        if (!s->status[0].step_index) {
            nb_samples++;
            buf_size -= ch;
        }
        nb_samples += buf_size * samples_per_byte / ch;
        break;
    }
    case CODEC_ID_ADPCM_SWF:
    {
        int buf_bits       = buf_size * 8 - 2;
        int nbits          = (buf[0] >> 6) + 2;
        int block_hdr_size = 22 * ch;
        int block_size     = block_hdr_size + nbits * ch * 4095;
        int nblocks        = buf_bits / block_size;
        int bits_left      = buf_bits - nblocks * block_size;
        nb_samples         = nblocks * 4096;
        if (bits_left >= block_hdr_size)
            nb_samples += 1 + (bits_left - block_hdr_size) / (nbits * ch);
        break;
    }
    case CODEC_ID_ADPCM_THP:
        has_coded_samples = 1;
        if (buf_size < 8)
            return 0;
        *coded_samples  = AV_RB32(&buf[4]);
        *coded_samples -= *coded_samples % 14;
        nb_samples      = (buf_size - 80) / (8 * ch) * 14;
        break;
    case CODEC_ID_ADPCM_XA:
        nb_samples = (buf_size / 128) * 224 / ch;
        break;
    }

    /* validate coded sample count */
    if (has_coded_samples && (*coded_samples <= 0 || *coded_samples > nb_samples))
        return AVERROR_INVALIDDATA;

    return nb_samples;
}
485

486 487 488 489
/* DK3 ADPCM support macro */
#define DK3_GET_NEXT_NIBBLE() \
    if (decode_top_nibble_next) \
    { \
490
        nibble = last_byte >> 4; \
491 492 493 494
        decode_top_nibble_next = 0; \
    } \
    else \
    { \
495 496
        if (end_of_packet) \
            break; \
497
        last_byte = *src++; \
498 499
        if (src >= buf + buf_size) \
            end_of_packet = 1; \
500 501 502 503
        nibble = last_byte & 0x0F; \
        decode_top_nibble_next = 1; \
    }

504
static int adpcm_decode_frame(AVCodecContext *avctx,
505
                            void *data, int *data_size,
506
                            AVPacket *avpkt)
507
{
508 509
    const uint8_t *buf = avpkt->data;
    int buf_size = avpkt->size;
510
    ADPCMDecodeContext *c = avctx->priv_data;
511
    ADPCMChannelStatus *cs;
Michael Niedermayer's avatar
Michael Niedermayer committed
512
    int n, m, channel, i;
513
    short *samples;
Michael Niedermayer's avatar
Michael Niedermayer committed
514
    const uint8_t *src;
515
    int st; /* stereo */
516
    int count1, count2;
517
    int nb_samples, coded_samples, out_bps, out_size;
518

519 520 521 522 523
    nb_samples = get_nb_samples(avctx, buf, buf_size, &coded_samples);
    if (nb_samples <= 0) {
        av_log(avctx, AV_LOG_ERROR, "invalid number of samples in packet\n");
        return AVERROR_INVALIDDATA;
    }
Mike Melanson's avatar
Mike Melanson committed
524

525 526 527 528 529 530 531 532 533 534 535 536 537 538
    out_bps  = av_get_bytes_per_sample(avctx->sample_fmt);
    out_size = nb_samples * avctx->channels * out_bps;
    if (*data_size < out_size) {
        av_log(avctx, AV_LOG_ERROR, "output buffer is too small\n");
        return AVERROR(EINVAL);
    }
    /* use coded_samples when applicable */
    /* it is always <= nb_samples, so the output buffer will be large enough */
    if (coded_samples) {
        if (coded_samples != nb_samples)
            av_log(avctx, AV_LOG_WARNING, "mismatch in coded sample count\n");
        nb_samples = coded_samples;
        out_size = nb_samples * avctx->channels * out_bps;
    }
539

540 541 542
    samples = data;
    src = buf;

543
    st = avctx->channels == 2 ? 1 : 0;
544 545 546

    switch(avctx->codec->id) {
    case CODEC_ID_ADPCM_IMA_QT:
547 548
        /* In QuickTime, IMA is encoded by chunks of 34 bytes (=64 samples).
           Channel data is interleaved per-chunk. */
549
        for (channel = 0; channel < avctx->channels; channel++) {
550 551
            int16_t predictor;
            int step_index;
Baptiste Coudurier's avatar
Baptiste Coudurier committed
552 553
            cs = &(c->status[channel]);
            /* (pppppp) (piiiiiii) */
554

Baptiste Coudurier's avatar
Baptiste Coudurier committed
555
            /* Bits 15-7 are the _top_ 9 bits of the 16-bit initial predictor value */
556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572
            predictor = AV_RB16(src);
            step_index = predictor & 0x7F;
            predictor &= 0xFF80;

            src += 2;

            if (cs->step_index == step_index) {
                int diff = (int)predictor - cs->predictor;
                if (diff < 0)
                    diff = - diff;
                if (diff > 0x7f)
                    goto update;
            } else {
            update:
                cs->step_index = step_index;
                cs->predictor = predictor;
            }
573

Baptiste Coudurier's avatar
Baptiste Coudurier committed
574 575 576 577
            if (cs->step_index > 88){
                av_log(avctx, AV_LOG_ERROR, "ERROR: step_index = %i\n", cs->step_index);
                cs->step_index = 88;
            }
578

Baptiste Coudurier's avatar
Baptiste Coudurier committed
579
            samples = (short*)data + channel;
580

581
            for (m = 0; m < 32; m++) {
582
                *samples = adpcm_ima_qt_expand_nibble(cs, src[0] & 0x0F, 3);
Baptiste Coudurier's avatar
Baptiste Coudurier committed
583
                samples += avctx->channels;
584
                *samples = adpcm_ima_qt_expand_nibble(cs, src[0] >> 4  , 3);
Baptiste Coudurier's avatar
Baptiste Coudurier committed
585 586 587
                samples += avctx->channels;
                src ++;
            }
588 589 590
        }
        break;
    case CODEC_ID_ADPCM_IMA_WAV:
591 592 593
        if (avctx->block_align != 0 && buf_size > avctx->block_align)
            buf_size = avctx->block_align;

Michael Niedermayer's avatar
Michael Niedermayer committed
594 595
        for(i=0; i<avctx->channels; i++){
            cs = &(c->status[i]);
596
            cs->predictor = *samples++ = (int16_t)bytestream_get_le16(&src);
597

Michael Niedermayer's avatar
Michael Niedermayer committed
598
            cs->step_index = *src++;
599 600 601 602 603
            if (cs->step_index > 88){
                av_log(avctx, AV_LOG_ERROR, "ERROR: step_index = %i\n", cs->step_index);
                cs->step_index = 88;
            }
            if (*src++) av_log(avctx, AV_LOG_ERROR, "unused byte should be null but is %d!!\n", src[-1]); /* unused */
604 605
        }

606
        for (n = (nb_samples - 1) / 8; n > 0; n--) {
607 608 609 610 611 612 613 614 615 616
            for (i = 0; i < avctx->channels; i++) {
                cs = &c->status[i];
                for (m = 0; m < 4; m++) {
                    uint8_t v = *src++;
                    *samples = adpcm_ima_expand_nibble(cs, v & 0x0F, 3);
                    samples += avctx->channels;
                    *samples = adpcm_ima_expand_nibble(cs, v >> 4  , 3);
                    samples += avctx->channels;
                }
                samples -= 8 * avctx->channels - 1;
617
            }
618
            samples += 7 * avctx->channels;
619
        }
Michael Niedermayer's avatar
Michael Niedermayer committed
620 621
        break;
    case CODEC_ID_ADPCM_4XM:
622 623
        for (i = 0; i < avctx->channels; i++)
            c->status[i].predictor= (int16_t)bytestream_get_le16(&src);
Michael Niedermayer's avatar
Michael Niedermayer committed
624

625 626 627
        for (i = 0; i < avctx->channels; i++) {
            c->status[i].step_index= (int16_t)bytestream_get_le16(&src);
            c->status[i].step_index = av_clip(c->status[i].step_index, 0, 88);
628
        }
Michael Niedermayer's avatar
Michael Niedermayer committed
629

630 631 632
        for (i = 0; i < avctx->channels; i++) {
            samples = (short*)data + i;
            cs = &c->status[i];
633 634
            for (n = nb_samples >> 1; n > 0; n--, src++) {
                uint8_t v = *src;
635 636 637 638 639 640
                *samples = adpcm_ima_expand_nibble(cs, v & 0x0F, 4);
                samples += avctx->channels;
                *samples = adpcm_ima_expand_nibble(cs, v >> 4  , 4);
                samples += avctx->channels;
            }
        }
641 642
        break;
    case CODEC_ID_ADPCM_MS:
643 644 645
    {
        int block_predictor;

646 647
        if (avctx->block_align != 0 && buf_size > avctx->block_align)
            buf_size = avctx->block_align;
648 649 650 651 652 653 654 655 656

        block_predictor = av_clip(*src++, 0, 6);
        c->status[0].coeff1 = ff_adpcm_AdaptCoeff1[block_predictor];
        c->status[0].coeff2 = ff_adpcm_AdaptCoeff2[block_predictor];
        if (st) {
            block_predictor = av_clip(*src++, 0, 6);
            c->status[1].coeff1 = ff_adpcm_AdaptCoeff1[block_predictor];
            c->status[1].coeff2 = ff_adpcm_AdaptCoeff2[block_predictor];
        }
657
        c->status[0].idelta = (int16_t)bytestream_get_le16(&src);
658
        if (st){
659
            c->status[1].idelta = (int16_t)bytestream_get_le16(&src);
660
        }
661

662 663 664 665
        c->status[0].sample1 = bytestream_get_le16(&src);
        if (st) c->status[1].sample1 = bytestream_get_le16(&src);
        c->status[0].sample2 = bytestream_get_le16(&src);
        if (st) c->status[1].sample2 = bytestream_get_le16(&src);
666 667 668

        *samples++ = c->status[0].sample2;
        if (st) *samples++ = c->status[1].sample2;
669 670
        *samples++ = c->status[0].sample1;
        if (st) *samples++ = c->status[1].sample1;
671
        for(n = (nb_samples - 2) >> (1 - st); n > 0; n--, src++) {
672
            *samples++ = adpcm_ms_expand_nibble(&c->status[0 ], src[0] >> 4  );
673 674 675
            *samples++ = adpcm_ms_expand_nibble(&c->status[st], src[0] & 0x0F);
        }
        break;
676
    }
677
    case CODEC_ID_ADPCM_IMA_DK4:
678 679 680
        if (avctx->block_align != 0 && buf_size > avctx->block_align)
            buf_size = avctx->block_align;

681 682 683 684
        for (channel = 0; channel < avctx->channels; channel++) {
            cs = &c->status[channel];
            cs->predictor  = (int16_t)bytestream_get_le16(&src);
            cs->step_index = *src++;
685
            src++;
686
            *samples++ = cs->predictor;
687
        }
688 689
        for (n = nb_samples >> (1 - st); n > 0; n--, src++) {
            uint8_t v = *src;
690 691
            *samples++ = adpcm_ima_expand_nibble(&c->status[0 ], v >> 4  , 3);
            *samples++ = adpcm_ima_expand_nibble(&c->status[st], v & 0x0F, 3);
692 693 694
        }
        break;
    case CODEC_ID_ADPCM_IMA_DK3:
695 696 697 698
    {
        unsigned char last_byte = 0;
        unsigned char nibble;
        int decode_top_nibble_next = 0;
699
        int end_of_packet = 0;
700 701
        int diff_channel;

702 703 704
        if (avctx->block_align != 0 && buf_size > avctx->block_align)
            buf_size = avctx->block_align;

705 706
        c->status[0].predictor  = (int16_t)AV_RL16(src + 10);
        c->status[1].predictor  = (int16_t)AV_RL16(src + 12);
707 708 709 710 711 712 713 714 715 716 717 718 719 720 721
        c->status[0].step_index = src[14];
        c->status[1].step_index = src[15];
        /* sign extend the predictors */
        src += 16;
        diff_channel = c->status[1].predictor;

        /* the DK3_GET_NEXT_NIBBLE macro issues the break statement when
         * the buffer is consumed */
        while (1) {

            /* for this algorithm, c->status[0] is the sum channel and
             * c->status[1] is the diff channel */

            /* process the first predictor of the sum channel */
            DK3_GET_NEXT_NIBBLE();
Michael Niedermayer's avatar
Michael Niedermayer committed
722
            adpcm_ima_expand_nibble(&c->status[0], nibble, 3);
723 724 725

            /* process the diff channel predictor */
            DK3_GET_NEXT_NIBBLE();
Michael Niedermayer's avatar
Michael Niedermayer committed
726
            adpcm_ima_expand_nibble(&c->status[1], nibble, 3);
727 728 729 730 731 732 733 734

            /* process the first pair of stereo PCM samples */
            diff_channel = (diff_channel + c->status[1].predictor) / 2;
            *samples++ = c->status[0].predictor + c->status[1].predictor;
            *samples++ = c->status[0].predictor - c->status[1].predictor;

            /* process the second predictor of the sum channel */
            DK3_GET_NEXT_NIBBLE();
Michael Niedermayer's avatar
Michael Niedermayer committed
735
            adpcm_ima_expand_nibble(&c->status[0], nibble, 3);
736 737 738 739 740 741 742

            /* process the second pair of stereo PCM samples */
            diff_channel = (diff_channel + c->status[1].predictor) / 2;
            *samples++ = c->status[0].predictor + c->status[1].predictor;
            *samples++ = c->status[0].predictor - c->status[1].predictor;
        }
        break;
743
    }
744
    case CODEC_ID_ADPCM_IMA_ISS:
745 746 747 748 749
        for (channel = 0; channel < avctx->channels; channel++) {
            cs = &c->status[channel];
            cs->predictor  = (int16_t)bytestream_get_le16(&src);
            cs->step_index = *src++;
            src++;
750 751
        }

752
        for (n = nb_samples >> (1 - st); n > 0; n--, src++) {
753
            uint8_t v1, v2;
754
            uint8_t v = *src;
755
            /* nibbles are swapped for mono */
756
            if (st) {
757 758
                v1 = v >> 4;
                v2 = v & 0x0F;
759
            } else {
760 761
                v2 = v >> 4;
                v1 = v & 0x0F;
762
            }
763 764
            *samples++ = adpcm_ima_expand_nibble(&c->status[0 ], v1, 3);
            *samples++ = adpcm_ima_expand_nibble(&c->status[st], v2, 3);
765 766
        }
        break;
767 768
    case CODEC_ID_ADPCM_IMA_WS:
        while (src < buf + buf_size) {
769 770 771
            uint8_t v = *src++;
            *samples++ = adpcm_ima_expand_nibble(&c->status[0],  v >> 4  , 3);
            *samples++ = adpcm_ima_expand_nibble(&c->status[st], v & 0x0F, 3);
772 773
        }
        break;
774 775
    case CODEC_ID_ADPCM_XA:
        while (buf_size >= 128) {
776
            xa_decode(samples, src, &c->status[0], &c->status[1],
777 778 779 780 781 782
                avctx->channels);
            src += 128;
            samples += 28 * 8;
            buf_size -= 128;
        }
        break;
783 784
    case CODEC_ID_ADPCM_IMA_EA_EACS:
        src += 4; // skip sample count (already read)
Peter Ross's avatar
Peter Ross committed
785 786 787 788 789 790

        for (i=0; i<=st; i++)
            c->status[i].step_index = bytestream_get_le32(&src);
        for (i=0; i<=st; i++)
            c->status[i].predictor  = bytestream_get_le32(&src);

791
        for (n = nb_samples >> (1 - st); n > 0; n--, src++) {
Peter Ross's avatar
Peter Ross committed
792 793 794 795
            *samples++ = adpcm_ima_expand_nibble(&c->status[0],  *src>>4,   3);
            *samples++ = adpcm_ima_expand_nibble(&c->status[st], *src&0x0F, 3);
        }
        break;
Peter Ross's avatar
Peter Ross committed
796
    case CODEC_ID_ADPCM_IMA_EA_SEAD:
797
        for (n = nb_samples >> (1 - st); n > 0; n--, src++) {
Peter Ross's avatar
Peter Ross committed
798 799 800 801
            *samples++ = adpcm_ima_expand_nibble(&c->status[0], src[0] >> 4, 6);
            *samples++ = adpcm_ima_expand_nibble(&c->status[st],src[0]&0x0F, 6);
        }
        break;
802
    case CODEC_ID_ADPCM_EA:
803 804 805 806 807 808 809
    {
        int32_t previous_left_sample, previous_right_sample;
        int32_t current_left_sample, current_right_sample;
        int32_t next_left_sample, next_right_sample;
        int32_t coeff1l, coeff2l, coeff1r, coeff2r;
        uint8_t shift_left, shift_right;

810 811
        /* Each EA ADPCM frame has a 12-byte header followed by 30-byte pieces,
           each coding 28 stereo samples. */
812 813 814

        src += 4; // skip sample count (already read)

815 816 817 818
        current_left_sample   = (int16_t)bytestream_get_le16(&src);
        previous_left_sample  = (int16_t)bytestream_get_le16(&src);
        current_right_sample  = (int16_t)bytestream_get_le16(&src);
        previous_right_sample = (int16_t)bytestream_get_le16(&src);
819

820
        for (count1 = 0; count1 < nb_samples / 28; count1++) {
821 822
            coeff1l = ea_adpcm_table[ *src >> 4       ];
            coeff2l = ea_adpcm_table[(*src >> 4  ) + 4];
823 824 825 826
            coeff1r = ea_adpcm_table[*src & 0x0F];
            coeff2r = ea_adpcm_table[(*src & 0x0F) + 4];
            src++;

Mans Rullgard's avatar
Mans Rullgard committed
827 828
            shift_left  = 20 - (*src >> 4);
            shift_right = 20 - (*src & 0x0F);
829 830 831
            src++;

            for (count2 = 0; count2 < 28; count2++) {
Mans Rullgard's avatar
Mans Rullgard committed
832 833
                next_left_sample  = sign_extend(*src >> 4, 4) << shift_left;
                next_right_sample = sign_extend(*src,      4) << shift_right;
834 835
                src++;

836 837
                next_left_sample = (next_left_sample +
                    (current_left_sample * coeff1l) +
838
                    (previous_left_sample * coeff2l) + 0x80) >> 8;
839 840
                next_right_sample = (next_right_sample +
                    (current_right_sample * coeff1r) +
841 842 843
                    (previous_right_sample * coeff2r) + 0x80) >> 8;

                previous_left_sample = current_left_sample;
844
                current_left_sample = av_clip_int16(next_left_sample);
845
                previous_right_sample = current_right_sample;
846
                current_right_sample = av_clip_int16(next_right_sample);
847 848 849 850
                *samples++ = (unsigned short)current_left_sample;
                *samples++ = (unsigned short)current_right_sample;
            }
        }
851 852 853 854

        if (src - buf == buf_size - 2)
            src += 2; // Skip terminating 0x0000

855
        break;
856
    }
857
    case CODEC_ID_ADPCM_EA_MAXIS_XA:
858 859 860
    {
        int coeff[2][2], shift[2];

861 862 863
        for(channel = 0; channel < avctx->channels; channel++) {
            for (i=0; i<2; i++)
                coeff[channel][i] = ea_adpcm_table[(*src >> 4) + 4*i];
Mans Rullgard's avatar
Mans Rullgard committed
864
            shift[channel] = 20 - (*src & 0x0F);
865 866
            src++;
        }
867
        for (count1 = 0; count1 < nb_samples / 2; count1++) {
868 869
            for(i = 4; i >= 0; i-=4) { /* Pairwise samples LL RR (st) or LL LL (mono) */
                for(channel = 0; channel < avctx->channels; channel++) {
Mans Rullgard's avatar
Mans Rullgard committed
870
                    int32_t sample = sign_extend(src[channel] >> i, 4) << shift[channel];
871 872 873 874 875 876 877 878 879 880
                    sample = (sample +
                             c->status[channel].sample1 * coeff[channel][0] +
                             c->status[channel].sample2 * coeff[channel][1] + 0x80) >> 8;
                    c->status[channel].sample2 = c->status[channel].sample1;
                    c->status[channel].sample1 = av_clip_int16(sample);
                    *samples++ = c->status[channel].sample1;
                }
            }
            src+=avctx->channels;
        }
881 882
        /* consume whole packet */
        src = buf + buf_size;
883
        break;
884
    }
885 886 887 888 889 890 891 892 893 894 895 896 897
    case CODEC_ID_ADPCM_EA_R1:
    case CODEC_ID_ADPCM_EA_R2:
    case CODEC_ID_ADPCM_EA_R3: {
        /* channel numbering
           2chan: 0=fl, 1=fr
           4chan: 0=fl, 1=rl, 2=fr, 3=rr
           6chan: 0=fl, 1=c,  2=fr, 3=rl,  4=rr, 5=sub */
        const int big_endian = avctx->codec->id == CODEC_ID_ADPCM_EA_R3;
        int32_t previous_sample, current_sample, next_sample;
        int32_t coeff1, coeff2;
        uint8_t shift;
        unsigned int channel;
        uint16_t *samplesC;
Michael Niedermayer's avatar
Michael Niedermayer committed
898
        const uint8_t *srcC;
899
        const uint8_t *src_end = buf + buf_size;
900
        int count = 0;
901

902
        src += 4; // skip sample count (already read)
903 904

        for (channel=0; channel<avctx->channels; channel++) {
905 906 907 908 909 910
            int32_t offset = (big_endian ? bytestream_get_be32(&src)
                                         : bytestream_get_le32(&src))
                           + (avctx->channels-channel-1) * 4;

            if ((offset < 0) || (offset >= src_end - src - 4)) break;
            srcC  = src + offset;
911 912 913 914 915 916 917 918 919 920
            samplesC = samples + channel;

            if (avctx->codec->id == CODEC_ID_ADPCM_EA_R1) {
                current_sample  = (int16_t)bytestream_get_le16(&srcC);
                previous_sample = (int16_t)bytestream_get_le16(&srcC);
            } else {
                current_sample  = c->status[channel].predictor;
                previous_sample = c->status[channel].prev_sample;
            }

921
            for (count1 = 0; count1 < nb_samples / 28; count1++) {
922 923
                if (*srcC == 0xEE) {  /* only seen in R2 and R3 */
                    srcC++;
924
                    if (srcC > src_end - 30*2) break;
925 926 927 928 929 930 931 932
                    current_sample  = (int16_t)bytestream_get_be16(&srcC);
                    previous_sample = (int16_t)bytestream_get_be16(&srcC);

                    for (count2=0; count2<28; count2++) {
                        *samplesC = (int16_t)bytestream_get_be16(&srcC);
                        samplesC += avctx->channels;
                    }
                } else {
933 934
                    coeff1 = ea_adpcm_table[ *srcC>>4     ];
                    coeff2 = ea_adpcm_table[(*srcC>>4) + 4];
Mans Rullgard's avatar
Mans Rullgard committed
935
                    shift = 20 - (*srcC++ & 0x0F);
936

937
                    if (srcC > src_end - 14) break;
938 939
                    for (count2=0; count2<28; count2++) {
                        if (count2 & 1)
Mans Rullgard's avatar
Mans Rullgard committed
940
                            next_sample = sign_extend(*srcC++,    4) << shift;
941
                        else
Mans Rullgard's avatar
Mans Rullgard committed
942
                            next_sample = sign_extend(*srcC >> 4, 4) << shift;
943 944 945 946 947 948 949 950 951 952 953 954

                        next_sample += (current_sample  * coeff1) +
                                       (previous_sample * coeff2);
                        next_sample = av_clip_int16(next_sample >> 8);

                        previous_sample = current_sample;
                        current_sample  = next_sample;
                        *samplesC = current_sample;
                        samplesC += avctx->channels;
                    }
                }
            }
955 956 957 958 959 960
            if (!count) {
                count = count1;
            } else if (count != count1) {
                av_log(avctx, AV_LOG_WARNING, "per-channel sample count mismatch\n");
                count = FFMAX(count, count1);
            }
961 962 963 964 965 966 967

            if (avctx->codec->id != CODEC_ID_ADPCM_EA_R1) {
                c->status[channel].predictor   = current_sample;
                c->status[channel].prev_sample = previous_sample;
            }
        }

968 969
        out_size = count * 28 * avctx->channels * out_bps;
        src = src_end;
970 971
        break;
    }
972 973 974 975 976 977 978
    case CODEC_ID_ADPCM_EA_XAS:
        for (channel=0; channel<avctx->channels; channel++) {
            int coeff[2][4], shift[4];
            short *s2, *s = &samples[channel];
            for (n=0; n<4; n++, s+=32*avctx->channels) {
                for (i=0; i<2; i++)
                    coeff[i][n] = ea_adpcm_table[(src[0]&0x0F)+4*i];
Mans Rullgard's avatar
Mans Rullgard committed
979
                shift[n] = 20 - (src[2] & 0x0F);
980 981 982 983 984 985 986 987
                for (s2=s, i=0; i<2; i++, src+=2, s2+=avctx->channels)
                    s2[0] = (src[0]&0xF0) + (src[1]<<8);
            }

            for (m=2; m<32; m+=2) {
                s = &samples[m*avctx->channels + channel];
                for (n=0; n<4; n++, src++, s+=32*avctx->channels) {
                    for (s2=s, i=0; i<8; i+=4, s2+=avctx->channels) {
Mans Rullgard's avatar
Mans Rullgard committed
988
                        int level = sign_extend(*src >> (4 - i), 4) << shift[n];
989 990 991 992 993 994 995 996
                        int pred  = s2[-1*avctx->channels] * coeff[0][n]
                                  + s2[-2*avctx->channels] * coeff[1][n];
                        s2[0] = av_clip_int16((level + pred + 0x80) >> 8);
                    }
                }
            }
        }
        break;
Vitor Sessak's avatar
Vitor Sessak committed
997
    case CODEC_ID_ADPCM_IMA_AMV:
998
    case CODEC_ID_ADPCM_IMA_SMJPEG:
999
        c->status[0].predictor = (int16_t)bytestream_get_le16(&src);
1000
        c->status[0].step_index = bytestream_get_le16(&src);
Vitor Sessak's avatar
Vitor Sessak committed
1001 1002 1003 1004

        if (avctx->codec->id == CODEC_ID_ADPCM_IMA_AMV)
            src+=4;

1005
        for (n = nb_samples >> (1 - st); n > 0; n--, src++) {
Vitor Sessak's avatar
Vitor Sessak committed
1006 1007
            char hi, lo;
            lo = *src & 0x0F;
1008
            hi = *src >> 4;
Vitor Sessak's avatar
Vitor Sessak committed
1009 1010 1011 1012

            if (avctx->codec->id == CODEC_ID_ADPCM_IMA_AMV)
                FFSWAP(char, hi, lo);

1013
            *samples++ = adpcm_ima_expand_nibble(&c->status[0],
Vitor Sessak's avatar
Vitor Sessak committed
1014
                lo, 3);
1015
            *samples++ = adpcm_ima_expand_nibble(&c->status[0],
Vitor Sessak's avatar
Vitor Sessak committed
1016
                hi, 3);
1017 1018
        }
        break;
1019
    case CODEC_ID_ADPCM_CT:
1020 1021
        for (n = nb_samples >> (1 - st); n > 0; n--, src++) {
            uint8_t v = *src;
1022 1023
            *samples++ = adpcm_ct_expand_nibble(&c->status[0 ], v >> 4  );
            *samples++ = adpcm_ct_expand_nibble(&c->status[st], v & 0x0F);
1024 1025
        }
        break;
1026 1027 1028 1029 1030 1031 1032 1033 1034
    case CODEC_ID_ADPCM_SBPRO_4:
    case CODEC_ID_ADPCM_SBPRO_3:
    case CODEC_ID_ADPCM_SBPRO_2:
        if (!c->status[0].step_index) {
            /* the first byte is a raw sample */
            *samples++ = 128 * (*src++ - 0x80);
            if (st)
              *samples++ = 128 * (*src++ - 0x80);
            c->status[0].step_index = 1;
1035
            nb_samples--;
1036 1037
        }
        if (avctx->codec->id == CODEC_ID_ADPCM_SBPRO_4) {
1038
            for (n = nb_samples >> (1 - st); n > 0; n--, src++) {
1039
                *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
1040
                    src[0] >> 4, 4, 0);
1041 1042 1043 1044
                *samples++ = adpcm_sbpro_expand_nibble(&c->status[st],
                    src[0] & 0x0F, 4, 0);
            }
        } else if (avctx->codec->id == CODEC_ID_ADPCM_SBPRO_3) {
1045
            for (n = nb_samples / 3; n > 0; n--, src++) {
1046
                *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
1047
                     src[0] >> 5        , 3, 0);
1048 1049 1050 1051 1052 1053
                *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
                    (src[0] >> 2) & 0x07, 3, 0);
                *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
                    src[0] & 0x03, 2, 0);
            }
        } else {
1054
            for (n = nb_samples >> (2 - st); n > 0; n--, src++) {
1055
                *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
1056
                     src[0] >> 6        , 2, 2);
1057 1058 1059 1060 1061 1062 1063 1064 1065
                *samples++ = adpcm_sbpro_expand_nibble(&c->status[st],
                    (src[0] >> 4) & 0x03, 2, 2);
                *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
                    (src[0] >> 2) & 0x03, 2, 2);
                *samples++ = adpcm_sbpro_expand_nibble(&c->status[st],
                    src[0] & 0x03, 2, 2);
            }
        }
        break;
1066 1067
    case CODEC_ID_ADPCM_SWF:
    {
1068 1069
        GetBitContext gb;
        const int *table;
1070
        int k0, signmask, nb_bits, count;
1071 1072 1073 1074
        int size = buf_size*8;

        init_get_bits(&gb, buf, size);

Diego Biurrun's avatar
Diego Biurrun committed
1075
        //read bits & initial values
1076 1077 1078 1079 1080
        nb_bits = get_bits(&gb, 2)+2;
        //av_log(NULL,AV_LOG_INFO,"nb_bits: %d\n", nb_bits);
        table = swf_index_tables[nb_bits-2];
        k0 = 1 << (nb_bits-2);
        signmask = 1 << (nb_bits-1);
1081

1082
        while (get_bits_count(&gb) <= size - 22*avctx->channels) {
1083
            for (i = 0; i < avctx->channels; i++) {
1084 1085 1086 1087 1088 1089 1090 1091 1092 1093
                *samples++ = c->status[i].predictor = get_sbits(&gb, 16);
                c->status[i].step_index = get_bits(&gb, 6);
            }

            for (count = 0; get_bits_count(&gb) <= size - nb_bits*avctx->channels && count < 4095; count++) {
                int i;

                for (i = 0; i < avctx->channels; i++) {
                    // similar to IMA adpcm
                    int delta = get_bits(&gb, nb_bits);
1094
                    int step = ff_adpcm_step_table[c->status[i].step_index];
1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113
                    long vpdiff = 0; // vpdiff = (delta+0.5)*step/4
                    int k = k0;

                    do {
                        if (delta & k)
                            vpdiff += step;
                        step >>= 1;
                        k >>= 1;
                    } while(k);
                    vpdiff += step;

                    if (delta & signmask)
                        c->status[i].predictor -= vpdiff;
                    else
                        c->status[i].predictor += vpdiff;

                    c->status[i].step_index += table[delta & (~signmask)];

                    c->status[i].step_index = av_clip(c->status[i].step_index, 0, 88);
1114
                    c->status[i].predictor = av_clip_int16(c->status[i].predictor);
1115 1116

                    *samples++ = c->status[i].predictor;
1117
                }
1118 1119
            }
        }
1120
        src += buf_size;
1121
        break;
1122
    }
1123
    case CODEC_ID_ADPCM_YAMAHA:
1124 1125
        for (n = nb_samples >> (1 - st); n > 0; n--, src++) {
            uint8_t v = *src;
1126 1127
            *samples++ = adpcm_yamaha_expand_nibble(&c->status[0 ], v & 0x0F);
            *samples++ = adpcm_yamaha_expand_nibble(&c->status[st], v >> 4  );
1128 1129
        }
        break;
1130
    case CODEC_ID_ADPCM_THP:
1131
    {
1132
        int table[2][16];
Michael Niedermayer's avatar
Michael Niedermayer committed
1133
        int prev[2][2];
1134 1135
        int ch;

1136 1137
        src += 4; // skip channel size
        src += 4; // skip number of samples (already read)
1138

Michael Niedermayer's avatar
Michael Niedermayer committed
1139
        for (i = 0; i < 32; i++)
1140
            table[0][i] = (int16_t)bytestream_get_be16(&src);
1141 1142

        /* Initialize the previous sample.  */
Michael Niedermayer's avatar
Michael Niedermayer committed
1143
        for (i = 0; i < 4; i++)
1144
            prev[0][i] = (int16_t)bytestream_get_be16(&src);
1145 1146 1147 1148 1149

        for (ch = 0; ch <= st; ch++) {
            samples = (unsigned short *) data + ch;

            /* Read in every sample for this channel.  */
1150
            for (i = 0; i < nb_samples / 14; i++) {
1151
                int index = (*src >> 4) & 7;
Mans Rullgard's avatar
Mans Rullgard committed
1152
                unsigned int exp = *src++ & 15;
1153 1154
                int factor1 = table[ch][index * 2];
                int factor2 = table[ch][index * 2 + 1];
1155 1156 1157

                /* Decode 14 samples.  */
                for (n = 0; n < 14; n++) {
1158
                    int32_t sampledat;
Mans Rullgard's avatar
Mans Rullgard committed
1159 1160
                    if(n&1) sampledat = sign_extend(*src++, 4);
                    else    sampledat = sign_extend(*src >> 4, 4);
1161

1162
                    sampledat = ((prev[ch][0]*factor1
Mans Rullgard's avatar
Mans Rullgard committed
1163
                                + prev[ch][1]*factor2) >> 11) + (sampledat << exp);
1164
                    *samples = av_clip_int16(sampledat);
Michael Niedermayer's avatar
Michael Niedermayer committed
1165 1166
                    prev[ch][1] = prev[ch][0];
                    prev[ch][0] = *samples++;
1167 1168 1169 1170 1171 1172 1173 1174

                    /* In case of stereo, skip one sample, this sample
                       is for the other channel.  */
                    samples += st;
                }
            }
        }
        break;
1175
    }
1176

1177 1178 1179
    default:
        return -1;
    }
1180
    *data_size = out_size;
1181 1182 1183
    return src - buf;
}

1184

1185 1186 1187 1188 1189 1190 1191 1192 1193
#define ADPCM_DECODER(id_, name_, long_name_)               \
AVCodec ff_ ## name_ ## _decoder = {                        \
    .name           = #name_,                               \
    .type           = AVMEDIA_TYPE_AUDIO,                   \
    .id             = id_,                                  \
    .priv_data_size = sizeof(ADPCMDecodeContext),           \
    .init           = adpcm_decode_init,                    \
    .decode         = adpcm_decode_frame,                   \
    .long_name      = NULL_IF_CONFIG_SMALL(long_name_),     \
1194
}
1195

1196
/* Note: Do not forget to add new entries to the Makefile as well. */
1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210
ADPCM_DECODER(CODEC_ID_ADPCM_4XM, adpcm_4xm, "ADPCM 4X Movie");
ADPCM_DECODER(CODEC_ID_ADPCM_CT, adpcm_ct, "ADPCM Creative Technology");
ADPCM_DECODER(CODEC_ID_ADPCM_EA, adpcm_ea, "ADPCM Electronic Arts");
ADPCM_DECODER(CODEC_ID_ADPCM_EA_MAXIS_XA, adpcm_ea_maxis_xa, "ADPCM Electronic Arts Maxis CDROM XA");
ADPCM_DECODER(CODEC_ID_ADPCM_EA_R1, adpcm_ea_r1, "ADPCM Electronic Arts R1");
ADPCM_DECODER(CODEC_ID_ADPCM_EA_R2, adpcm_ea_r2, "ADPCM Electronic Arts R2");
ADPCM_DECODER(CODEC_ID_ADPCM_EA_R3, adpcm_ea_r3, "ADPCM Electronic Arts R3");
ADPCM_DECODER(CODEC_ID_ADPCM_EA_XAS, adpcm_ea_xas, "ADPCM Electronic Arts XAS");
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_AMV, adpcm_ima_amv, "ADPCM IMA AMV");
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_DK3, adpcm_ima_dk3, "ADPCM IMA Duck DK3");
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_DK4, adpcm_ima_dk4, "ADPCM IMA Duck DK4");
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_EA_EACS, adpcm_ima_ea_eacs, "ADPCM IMA Electronic Arts EACS");
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_EA_SEAD, adpcm_ima_ea_sead, "ADPCM IMA Electronic Arts SEAD");
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_ISS, adpcm_ima_iss, "ADPCM IMA Funcom ISS");
1211
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_QT, adpcm_ima_qt, "ADPCM IMA QuickTime");
1212
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_SMJPEG, adpcm_ima_smjpeg, "ADPCM IMA Loki SDL MJPEG");
1213
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_WAV, adpcm_ima_wav, "ADPCM IMA WAV");
1214
ADPCM_DECODER(CODEC_ID_ADPCM_IMA_WS, adpcm_ima_ws, "ADPCM IMA Westwood");
1215
ADPCM_DECODER(CODEC_ID_ADPCM_MS, adpcm_ms, "ADPCM Microsoft");
1216 1217 1218
ADPCM_DECODER(CODEC_ID_ADPCM_SBPRO_2, adpcm_sbpro_2, "ADPCM Sound Blaster Pro 2-bit");
ADPCM_DECODER(CODEC_ID_ADPCM_SBPRO_3, adpcm_sbpro_3, "ADPCM Sound Blaster Pro 2.6-bit");
ADPCM_DECODER(CODEC_ID_ADPCM_SBPRO_4, adpcm_sbpro_4, "ADPCM Sound Blaster Pro 4-bit");
1219
ADPCM_DECODER(CODEC_ID_ADPCM_SWF, adpcm_swf, "ADPCM Shockwave Flash");
1220 1221
ADPCM_DECODER(CODEC_ID_ADPCM_THP, adpcm_thp, "ADPCM Nintendo Gamecube THP");
ADPCM_DECODER(CODEC_ID_ADPCM_XA, adpcm_xa, "ADPCM CDROM XA");
1222
ADPCM_DECODER(CODEC_ID_ADPCM_YAMAHA, adpcm_yamaha, "ADPCM Yamaha");