]> git.sesse.net Git - ffmpeg/blob - libavcodec/adpcm.c
8ab3bd89543c9aa0237caaa6dbca18a7e47eb39b
[ffmpeg] / libavcodec / adpcm.c
1 /*
2  * Copyright (c) 2001-2003 The ffmpeg Project
3  *
4  * This file is part of Libav.
5  *
6  * Libav is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * 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  * Libav is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License along with Libav; 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 #include "adpcm.h"
25 #include "adpcm_data.h"
26
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)
36  * EA IMA EACS decoder by Peter Ross (pross@xvid.org)
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  * Features and limitations:
43  *
44  * Reference documents:
45  * http://wiki.multimedia.cx/index.php?title=Category:ADPCM_Audio_Codecs
46  * http://www.pcisys.net/~melanson/codecs/simpleaudio.html [dead]
47  * http://www.geocities.com/SiliconValley/8682/aud3.txt [dead]
48  * http://openquicktime.sourceforge.net/
49  * XAnim sources (xa_codec.c) http://xanim.polter.net/
50  * http://www.cs.ucla.edu/~leec/mediabench/applications.html [dead]
51  * SoX source code http://sox.sourceforge.net/
52  *
53  * CD-ROM XA:
54  * http://ku-www.ss.titech.ac.jp/~yatsushi/xaadpcm.html [dead]
55  * 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 */
60 static const int xa_adpcm_table[5][2] = {
61     {   0,   0 },
62     {  60,   0 },
63     { 115, -52 },
64     {  98, -55 },
65     { 122, -60 }
66 };
67
68 static const int ea_adpcm_table[] = {
69     0,  240,  460,  392,
70     0,    0, -208, -220,
71     0,    1,    3,    4,
72     7,    8,   10,   11,
73     0,   -1,   -3,   -4
74 };
75
76 // padded to zero where table size is less then 16
77 static const int swf_index_tables[4][16] = {
78     /*2*/ { -1, 2 },
79     /*3*/ { -1, -1, 2, 4 },
80     /*4*/ { -1, -1, -1, -1, 2, 4, 6, 8 },
81     /*5*/ { -1, -1, -1, -1, -1, -1, -1, -1, 1, 2, 4, 6, 8, 10, 13, 16 }
82 };
83
84 /* end of tables */
85
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;
93     unsigned int max_channels = 2;
94
95     switch(avctx->codec->id) {
96     case CODEC_ID_ADPCM_EA_R1:
97     case CODEC_ID_ADPCM_EA_R2:
98     case CODEC_ID_ADPCM_EA_R3:
99     case CODEC_ID_ADPCM_EA_XAS:
100         max_channels = 6;
101         break;
102     }
103     if(avctx->channels > max_channels){
104         return -1;
105     }
106
107     switch(avctx->codec->id) {
108     case CODEC_ID_ADPCM_CT:
109         c->status[0].step = c->status[1].step = 511;
110         break;
111     case CODEC_ID_ADPCM_IMA_WAV:
112         if (avctx->bits_per_coded_sample != 4) {
113             av_log(avctx, AV_LOG_ERROR, "Only 4-bit ADPCM IMA WAV files are supported\n");
114             return -1;
115         }
116         break;
117     case CODEC_ID_ADPCM_IMA_WS:
118         if (avctx->extradata && avctx->extradata_size == 2 * 4) {
119             c->status[0].predictor = AV_RL32(avctx->extradata);
120             c->status[1].predictor = AV_RL32(avctx->extradata + 4);
121         }
122         break;
123     default:
124         break;
125     }
126     avctx->sample_fmt = AV_SAMPLE_FMT_S16;
127     return 0;
128 }
129
130 static inline short adpcm_ima_expand_nibble(ADPCMChannelStatus *c, char nibble, int shift)
131 {
132     int step_index;
133     int predictor;
134     int sign, delta, diff, step;
135
136     step = ff_adpcm_step_table[c->step_index];
137     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     sign = nibble & 8;
142     delta = nibble & 7;
143     /* perform direct multiplication instead of series of jumps proposed by
144      * the reference ADPCM implementation since modern CPUs can do the mults
145      * quickly enough */
146     diff = ((2 * delta + 1) * step) >> shift;
147     predictor = c->predictor;
148     if (sign) predictor -= diff;
149     else predictor += diff;
150
151     c->predictor = av_clip_int16(predictor);
152     c->step_index = step_index;
153
154     return (short)c->predictor;
155 }
156
157 static inline int adpcm_ima_qt_expand_nibble(ADPCMChannelStatus *c, int nibble, int shift)
158 {
159     int step_index;
160     int predictor;
161     int diff, step;
162
163     step = ff_adpcm_step_table[c->step_index];
164     step_index = c->step_index + ff_adpcm_index_table[nibble];
165     step_index = av_clip(step_index, 0, 88);
166
167     diff = step >> 3;
168     if (nibble & 4) diff += step;
169     if (nibble & 2) diff += step >> 1;
170     if (nibble & 1) diff += step >> 2;
171
172     if (nibble & 8)
173         predictor = c->predictor - diff;
174     else
175         predictor = c->predictor + diff;
176
177     c->predictor = av_clip_int16(predictor);
178     c->step_index = step_index;
179
180     return c->predictor;
181 }
182
183 static inline short adpcm_ms_expand_nibble(ADPCMChannelStatus *c, char nibble)
184 {
185     int predictor;
186
187     predictor = (((c->sample1) * (c->coeff1)) + ((c->sample2) * (c->coeff2))) / 64;
188     predictor += (signed)((nibble & 0x08)?(nibble - 0x10):(nibble)) * c->idelta;
189
190     c->sample2 = c->sample1;
191     c->sample1 = av_clip_int16(predictor);
192     c->idelta = (ff_adpcm_AdaptationTable[(int)nibble] * c->idelta) >> 8;
193     if (c->idelta < 16) c->idelta = 16;
194
195     return c->sample1;
196 }
197
198 static inline short adpcm_ct_expand_nibble(ADPCMChannelStatus *c, char nibble)
199 {
200     int sign, delta, diff;
201     int new_step;
202
203     sign = nibble & 8;
204     delta = nibble & 7;
205     /* perform direct multiplication instead of series of jumps proposed by
206      * the reference ADPCM implementation since modern CPUs can do the mults
207      * quickly enough */
208     diff = ((2 * delta + 1) * c->step) >> 3;
209     /* predictor update is not so trivial: predictor is multiplied on 254/256 before updating */
210     c->predictor = ((c->predictor * 254) >> 8) + (sign ? -diff : diff);
211     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 static inline short adpcm_sbpro_expand_nibble(ADPCMChannelStatus *c, char nibble, int size, int shift)
220 {
221     int sign, delta, diff;
222
223     sign = nibble & (1<<(size-1));
224     delta = nibble & ((1<<(size-1))-1);
225     diff = delta << (7 + c->step + shift);
226
227     /* clamp result */
228     c->predictor = av_clip(c->predictor + (sign ? -diff : diff), -16384,16256);
229
230     /* calculate new step */
231     if (delta >= (2*size - 3) && c->step < 3)
232         c->step++;
233     else if (delta == 0 && c->step > 0)
234         c->step--;
235
236     return (short) c->predictor;
237 }
238
239 static inline short adpcm_yamaha_expand_nibble(ADPCMChannelStatus *c, unsigned char nibble)
240 {
241     if(!c->step) {
242         c->predictor = 0;
243         c->step = 127;
244     }
245
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     return c->predictor;
251 }
252
253 static void xa_decode(short *out, const unsigned char *in,
254     ADPCMChannelStatus *left, ADPCMChannelStatus *right, int inc)
255 {
256     int i, j;
257     int shift,filter,f0,f1;
258     int s_1,s_2;
259     int d,s,t;
260
261     for(i=0;i<4;i++) {
262
263         shift  = 12 - (in[4+i*2] & 15);
264         filter = in[4+i*2] >> 4;
265         f0 = xa_adpcm_table[filter][0];
266         f1 = xa_adpcm_table[filter][1];
267
268         s_1 = left->sample1;
269         s_2 = left->sample2;
270
271         for(j=0;j<28;j++) {
272             d = in[16+i+j*4];
273
274             t = (signed char)(d<<4)>>4;
275             s = ( t<<shift ) + ((s_1*f0 + s_2*f1+32)>>6);
276             s_2 = s_1;
277             s_1 = av_clip_int16(s);
278             *out = s_1;
279             out += inc;
280         }
281
282         if (inc==2) { /* stereo */
283             left->sample1 = s_1;
284             left->sample2 = s_2;
285             s_1 = right->sample1;
286             s_2 = right->sample2;
287             out = out + 1 - 28*2;
288         }
289
290         shift  = 12 - (in[5+i*2] & 15);
291         filter = in[5+i*2] >> 4;
292
293         f0 = xa_adpcm_table[filter][0];
294         f1 = xa_adpcm_table[filter][1];
295
296         for(j=0;j<28;j++) {
297             d = in[16+i+j*4];
298
299             t = (signed char)d >> 4;
300             s = ( t<<shift ) + ((s_1*f0 + s_2*f1+32)>>6);
301             s_2 = s_1;
302             s_1 = av_clip_int16(s);
303             *out = s_1;
304             out += inc;
305         }
306
307         if (inc==2) { /* stereo */
308             right->sample1 = s_1;
309             right->sample2 = s_2;
310             out -= 1;
311         } else {
312             left->sample1 = s_1;
313             left->sample2 = s_2;
314         }
315     }
316 }
317
318
319 /* DK3 ADPCM support macro */
320 #define DK3_GET_NEXT_NIBBLE() \
321     if (decode_top_nibble_next) \
322     { \
323         nibble = last_byte >> 4; \
324         decode_top_nibble_next = 0; \
325     } \
326     else \
327     { \
328         last_byte = *src++; \
329         if (src >= buf + buf_size) break; \
330         nibble = last_byte & 0x0F; \
331         decode_top_nibble_next = 1; \
332     }
333
334 static int adpcm_decode_frame(AVCodecContext *avctx,
335                             void *data, int *data_size,
336                             AVPacket *avpkt)
337 {
338     const uint8_t *buf = avpkt->data;
339     int buf_size = avpkt->size;
340     ADPCMDecodeContext *c = avctx->priv_data;
341     ADPCMChannelStatus *cs;
342     int n, m, channel, i;
343     short *samples;
344     short *samples_end;
345     const uint8_t *src;
346     int st; /* stereo */
347     uint32_t samples_in_chunk;
348     int count1, count2;
349
350     //should protect all 4bit ADPCM variants
351     //8 is needed for CODEC_ID_ADPCM_IMA_WAV with 2 channels
352     //
353     if(*data_size/4 < buf_size + 8)
354         return -1;
355
356     samples = data;
357     samples_end= samples + *data_size/2;
358     src = buf;
359
360     st = avctx->channels == 2 ? 1 : 0;
361
362     switch(avctx->codec->id) {
363     case CODEC_ID_ADPCM_IMA_QT:
364         /* In QuickTime, IMA is encoded by chunks of 34 bytes (=64 samples).
365            Channel data is interleaved per-chunk. */
366         if (buf_size / 34 < avctx->channels) {
367             av_log(avctx, AV_LOG_ERROR, "packet is too small\n");
368             return AVERROR(EINVAL);
369         }
370         for (channel = 0; channel < avctx->channels; channel++) {
371             int16_t predictor;
372             int step_index;
373             cs = &(c->status[channel]);
374             /* (pppppp) (piiiiiii) */
375
376             /* Bits 15-7 are the _top_ 9 bits of the 16-bit initial predictor value */
377             predictor = AV_RB16(src);
378             step_index = predictor & 0x7F;
379             predictor &= 0xFF80;
380
381             src += 2;
382
383             if (cs->step_index == step_index) {
384                 int diff = (int)predictor - cs->predictor;
385                 if (diff < 0)
386                     diff = - diff;
387                 if (diff > 0x7f)
388                     goto update;
389             } else {
390             update:
391                 cs->step_index = step_index;
392                 cs->predictor = predictor;
393             }
394
395             if (cs->step_index > 88){
396                 av_log(avctx, AV_LOG_ERROR, "ERROR: step_index = %i\n", cs->step_index);
397                 cs->step_index = 88;
398             }
399
400             samples = (short*)data + channel;
401
402             for (m = 0; m < 32; m++) {
403                 *samples = adpcm_ima_qt_expand_nibble(cs, src[0] & 0x0F, 3);
404                 samples += avctx->channels;
405                 *samples = adpcm_ima_qt_expand_nibble(cs, src[0] >> 4  , 3);
406                 samples += avctx->channels;
407                 src ++;
408             }
409         }
410         if (st)
411             samples--;
412         break;
413     case CODEC_ID_ADPCM_IMA_WAV:
414         if (avctx->block_align != 0 && buf_size > avctx->block_align)
415             buf_size = avctx->block_align;
416
417 //        samples_per_block= (block_align-4*chanels)*8 / (bits_per_sample * chanels) + 1;
418
419         for(i=0; i<avctx->channels; i++){
420             cs = &(c->status[i]);
421             cs->predictor = *samples++ = (int16_t)bytestream_get_le16(&src);
422
423             cs->step_index = *src++;
424             if (cs->step_index > 88){
425                 av_log(avctx, AV_LOG_ERROR, "ERROR: step_index = %i\n", cs->step_index);
426                 cs->step_index = 88;
427             }
428             if (*src++) av_log(avctx, AV_LOG_ERROR, "unused byte should be null but is %d!!\n", src[-1]); /* unused */
429         }
430
431         while(src < buf + buf_size){
432             for (i = 0; i < avctx->channels; i++) {
433                 cs = &c->status[i];
434                 for (m = 0; m < 4; m++) {
435                     uint8_t v = *src++;
436                     *samples = adpcm_ima_expand_nibble(cs, v & 0x0F, 3);
437                     samples += avctx->channels;
438                     *samples = adpcm_ima_expand_nibble(cs, v >> 4  , 3);
439                     samples += avctx->channels;
440                 }
441                 samples -= 8 * avctx->channels - 1;
442             }
443             samples += 7 * avctx->channels;
444         }
445         break;
446     case CODEC_ID_ADPCM_4XM:
447         for (i = 0; i < avctx->channels; i++)
448             c->status[i].predictor= (int16_t)bytestream_get_le16(&src);
449
450         for (i = 0; i < avctx->channels; i++) {
451             c->status[i].step_index= (int16_t)bytestream_get_le16(&src);
452             c->status[i].step_index = av_clip(c->status[i].step_index, 0, 88);
453         }
454
455         m= (buf_size - (src - buf))>>st;
456
457         for (i = 0; i < avctx->channels; i++) {
458             samples = (short*)data + i;
459             cs = &c->status[i];
460             for (n = 0; n < m; n++) {
461                 uint8_t v = *src++;
462                 *samples = adpcm_ima_expand_nibble(cs, v & 0x0F, 4);
463                 samples += avctx->channels;
464                 *samples = adpcm_ima_expand_nibble(cs, v >> 4  , 4);
465                 samples += avctx->channels;
466             }
467         }
468         samples -= (avctx->channels - 1);
469         break;
470     case CODEC_ID_ADPCM_MS:
471     {
472         int block_predictor;
473
474         if (avctx->block_align != 0 && buf_size > avctx->block_align)
475             buf_size = avctx->block_align;
476         n = buf_size - 7 * avctx->channels;
477         if (n < 0)
478             return -1;
479
480         block_predictor = av_clip(*src++, 0, 6);
481         c->status[0].coeff1 = ff_adpcm_AdaptCoeff1[block_predictor];
482         c->status[0].coeff2 = ff_adpcm_AdaptCoeff2[block_predictor];
483         if (st) {
484             block_predictor = av_clip(*src++, 0, 6);
485             c->status[1].coeff1 = ff_adpcm_AdaptCoeff1[block_predictor];
486             c->status[1].coeff2 = ff_adpcm_AdaptCoeff2[block_predictor];
487         }
488         c->status[0].idelta = (int16_t)bytestream_get_le16(&src);
489         if (st){
490             c->status[1].idelta = (int16_t)bytestream_get_le16(&src);
491         }
492
493         c->status[0].sample1 = bytestream_get_le16(&src);
494         if (st) c->status[1].sample1 = bytestream_get_le16(&src);
495         c->status[0].sample2 = bytestream_get_le16(&src);
496         if (st) c->status[1].sample2 = bytestream_get_le16(&src);
497
498         *samples++ = c->status[0].sample2;
499         if (st) *samples++ = c->status[1].sample2;
500         *samples++ = c->status[0].sample1;
501         if (st) *samples++ = c->status[1].sample1;
502         for(;n>0;n--) {
503             *samples++ = adpcm_ms_expand_nibble(&c->status[0 ], src[0] >> 4  );
504             *samples++ = adpcm_ms_expand_nibble(&c->status[st], src[0] & 0x0F);
505             src ++;
506         }
507         break;
508     }
509     case CODEC_ID_ADPCM_IMA_DK4:
510         if (avctx->block_align != 0 && buf_size > avctx->block_align)
511             buf_size = avctx->block_align;
512
513         n = buf_size - 4 * avctx->channels;
514         if (n < 0) {
515             av_log(avctx, AV_LOG_ERROR, "packet is too small\n");
516             return AVERROR(EINVAL);
517         }
518
519         for (channel = 0; channel < avctx->channels; channel++) {
520             cs = &c->status[channel];
521             cs->predictor  = (int16_t)bytestream_get_le16(&src);
522             cs->step_index = *src++;
523             src++;
524             *samples++ = cs->predictor;
525         }
526         while (n-- > 0) {
527             uint8_t v = *src++;
528             *samples++ = adpcm_ima_expand_nibble(&c->status[0 ], v >> 4  , 3);
529             *samples++ = adpcm_ima_expand_nibble(&c->status[st], v & 0x0F, 3);
530         }
531         break;
532     case CODEC_ID_ADPCM_IMA_DK3:
533     {
534         unsigned char last_byte = 0;
535         unsigned char nibble;
536         int decode_top_nibble_next = 0;
537         int diff_channel;
538
539         if (avctx->block_align != 0 && buf_size > avctx->block_align)
540             buf_size = avctx->block_align;
541
542         if(buf_size + 16 > (samples_end - samples)*3/8)
543             return -1;
544
545         c->status[0].predictor  = (int16_t)AV_RL16(src + 10);
546         c->status[1].predictor  = (int16_t)AV_RL16(src + 12);
547         c->status[0].step_index = src[14];
548         c->status[1].step_index = src[15];
549         /* sign extend the predictors */
550         src += 16;
551         diff_channel = c->status[1].predictor;
552
553         /* the DK3_GET_NEXT_NIBBLE macro issues the break statement when
554          * the buffer is consumed */
555         while (1) {
556
557             /* for this algorithm, c->status[0] is the sum channel and
558              * c->status[1] is the diff channel */
559
560             /* process the first predictor of the sum channel */
561             DK3_GET_NEXT_NIBBLE();
562             adpcm_ima_expand_nibble(&c->status[0], nibble, 3);
563
564             /* process the diff channel predictor */
565             DK3_GET_NEXT_NIBBLE();
566             adpcm_ima_expand_nibble(&c->status[1], nibble, 3);
567
568             /* process the first pair of stereo PCM samples */
569             diff_channel = (diff_channel + c->status[1].predictor) / 2;
570             *samples++ = c->status[0].predictor + c->status[1].predictor;
571             *samples++ = c->status[0].predictor - c->status[1].predictor;
572
573             /* process the second predictor of the sum channel */
574             DK3_GET_NEXT_NIBBLE();
575             adpcm_ima_expand_nibble(&c->status[0], nibble, 3);
576
577             /* process the second pair of stereo PCM samples */
578             diff_channel = (diff_channel + c->status[1].predictor) / 2;
579             *samples++ = c->status[0].predictor + c->status[1].predictor;
580             *samples++ = c->status[0].predictor - c->status[1].predictor;
581         }
582         break;
583     }
584     case CODEC_ID_ADPCM_IMA_ISS:
585         n = buf_size - 4 * avctx->channels;
586         if (n < 0) {
587             av_log(avctx, AV_LOG_ERROR, "packet is too small\n");
588             return AVERROR(EINVAL);
589         }
590
591         for (channel = 0; channel < avctx->channels; channel++) {
592             cs = &c->status[channel];
593             cs->predictor  = (int16_t)bytestream_get_le16(&src);
594             cs->step_index = *src++;
595             src++;
596         }
597
598         while (n-- > 0) {
599             uint8_t v1, v2;
600             uint8_t v = *src++;
601             /* nibbles are swapped for mono */
602             if (st) {
603                 v1 = v >> 4;
604                 v2 = v & 0x0F;
605             } else {
606                 v2 = v >> 4;
607                 v1 = v & 0x0F;
608             }
609             *samples++ = adpcm_ima_expand_nibble(&c->status[0 ], v1, 3);
610             *samples++ = adpcm_ima_expand_nibble(&c->status[st], v2, 3);
611         }
612         break;
613     case CODEC_ID_ADPCM_IMA_WS:
614         while (src < buf + buf_size) {
615             uint8_t v = *src++;
616             *samples++ = adpcm_ima_expand_nibble(&c->status[0],  v >> 4  , 3);
617             *samples++ = adpcm_ima_expand_nibble(&c->status[st], v & 0x0F, 3);
618         }
619         break;
620     case CODEC_ID_ADPCM_XA:
621         while (buf_size >= 128) {
622             xa_decode(samples, src, &c->status[0], &c->status[1],
623                 avctx->channels);
624             src += 128;
625             samples += 28 * 8;
626             buf_size -= 128;
627         }
628         break;
629     case CODEC_ID_ADPCM_IMA_EA_EACS: {
630         unsigned header_size = 4 + (8<<st);
631         samples_in_chunk = bytestream_get_le32(&src) >> (1-st);
632
633         if (buf_size < header_size || samples_in_chunk > buf_size - header_size) {
634             src += buf_size - 4;
635             break;
636         }
637
638         for (i=0; i<=st; i++)
639             c->status[i].step_index = bytestream_get_le32(&src);
640         for (i=0; i<=st; i++)
641             c->status[i].predictor  = bytestream_get_le32(&src);
642
643         for (; samples_in_chunk; samples_in_chunk--, src++) {
644             *samples++ = adpcm_ima_expand_nibble(&c->status[0],  *src>>4,   3);
645             *samples++ = adpcm_ima_expand_nibble(&c->status[st], *src&0x0F, 3);
646         }
647         break;
648     }
649     case CODEC_ID_ADPCM_IMA_EA_SEAD:
650         for (; src < buf+buf_size; src++) {
651             *samples++ = adpcm_ima_expand_nibble(&c->status[0], src[0] >> 4, 6);
652             *samples++ = adpcm_ima_expand_nibble(&c->status[st],src[0]&0x0F, 6);
653         }
654         break;
655     case CODEC_ID_ADPCM_EA:
656     {
657         int32_t previous_left_sample, previous_right_sample;
658         int32_t current_left_sample, current_right_sample;
659         int32_t next_left_sample, next_right_sample;
660         int32_t coeff1l, coeff2l, coeff1r, coeff2r;
661         uint8_t shift_left, shift_right;
662
663         /* Each EA ADPCM frame has a 12-byte header followed by 30-byte pieces,
664            each coding 28 stereo samples. */
665         if (buf_size < 12) {
666             av_log(avctx, AV_LOG_ERROR, "frame too small\n");
667             return AVERROR(EINVAL);
668         }
669         samples_in_chunk = AV_RL32(src);
670         if (samples_in_chunk / 28 > (buf_size - 12) / 30) {
671             av_log(avctx, AV_LOG_ERROR, "invalid frame\n");
672             return AVERROR(EINVAL);
673         }
674         src += 4;
675         current_left_sample   = (int16_t)bytestream_get_le16(&src);
676         previous_left_sample  = (int16_t)bytestream_get_le16(&src);
677         current_right_sample  = (int16_t)bytestream_get_le16(&src);
678         previous_right_sample = (int16_t)bytestream_get_le16(&src);
679
680         for (count1 = 0; count1 < samples_in_chunk/28;count1++) {
681             coeff1l = ea_adpcm_table[ *src >> 4       ];
682             coeff2l = ea_adpcm_table[(*src >> 4  ) + 4];
683             coeff1r = ea_adpcm_table[*src & 0x0F];
684             coeff2r = ea_adpcm_table[(*src & 0x0F) + 4];
685             src++;
686
687             shift_left  = (*src >> 4  ) + 8;
688             shift_right = (*src & 0x0F) + 8;
689             src++;
690
691             for (count2 = 0; count2 < 28; count2++) {
692                 next_left_sample  = (int32_t)((*src & 0xF0) << 24) >> shift_left;
693                 next_right_sample = (int32_t)((*src & 0x0F) << 28) >> shift_right;
694                 src++;
695
696                 next_left_sample = (next_left_sample +
697                     (current_left_sample * coeff1l) +
698                     (previous_left_sample * coeff2l) + 0x80) >> 8;
699                 next_right_sample = (next_right_sample +
700                     (current_right_sample * coeff1r) +
701                     (previous_right_sample * coeff2r) + 0x80) >> 8;
702
703                 previous_left_sample = current_left_sample;
704                 current_left_sample = av_clip_int16(next_left_sample);
705                 previous_right_sample = current_right_sample;
706                 current_right_sample = av_clip_int16(next_right_sample);
707                 *samples++ = (unsigned short)current_left_sample;
708                 *samples++ = (unsigned short)current_right_sample;
709             }
710         }
711
712         if (src - buf == buf_size - 2)
713             src += 2; // Skip terminating 0x0000
714
715         break;
716     }
717     case CODEC_ID_ADPCM_EA_MAXIS_XA:
718     {
719         int coeff[2][2], shift[2];
720
721         for(channel = 0; channel < avctx->channels; channel++) {
722             for (i=0; i<2; i++)
723                 coeff[channel][i] = ea_adpcm_table[(*src >> 4) + 4*i];
724             shift[channel] = (*src & 0x0F) + 8;
725             src++;
726         }
727         for (count1 = 0; count1 < (buf_size - avctx->channels) / avctx->channels; count1++) {
728             for(i = 4; i >= 0; i-=4) { /* Pairwise samples LL RR (st) or LL LL (mono) */
729                 for(channel = 0; channel < avctx->channels; channel++) {
730                     int32_t sample = (int32_t)(((*(src+channel) >> i) & 0x0F) << 0x1C) >> shift[channel];
731                     sample = (sample +
732                              c->status[channel].sample1 * coeff[channel][0] +
733                              c->status[channel].sample2 * coeff[channel][1] + 0x80) >> 8;
734                     c->status[channel].sample2 = c->status[channel].sample1;
735                     c->status[channel].sample1 = av_clip_int16(sample);
736                     *samples++ = c->status[channel].sample1;
737                 }
738             }
739             src+=avctx->channels;
740         }
741         break;
742     }
743     case CODEC_ID_ADPCM_EA_R1:
744     case CODEC_ID_ADPCM_EA_R2:
745     case CODEC_ID_ADPCM_EA_R3: {
746         /* channel numbering
747            2chan: 0=fl, 1=fr
748            4chan: 0=fl, 1=rl, 2=fr, 3=rr
749            6chan: 0=fl, 1=c,  2=fr, 3=rl,  4=rr, 5=sub */
750         const int big_endian = avctx->codec->id == CODEC_ID_ADPCM_EA_R3;
751         int32_t previous_sample, current_sample, next_sample;
752         int32_t coeff1, coeff2;
753         uint8_t shift;
754         unsigned int channel;
755         uint16_t *samplesC;
756         const uint8_t *srcC;
757         const uint8_t *src_end = buf + buf_size;
758
759         samples_in_chunk = (big_endian ? bytestream_get_be32(&src)
760                                        : bytestream_get_le32(&src)) / 28;
761         if (samples_in_chunk > UINT32_MAX/(28*avctx->channels) ||
762             28*samples_in_chunk*avctx->channels > samples_end-samples) {
763             src += buf_size - 4;
764             break;
765         }
766
767         for (channel=0; channel<avctx->channels; channel++) {
768             int32_t offset = (big_endian ? bytestream_get_be32(&src)
769                                          : bytestream_get_le32(&src))
770                            + (avctx->channels-channel-1) * 4;
771
772             if ((offset < 0) || (offset >= src_end - src - 4)) break;
773             srcC  = src + offset;
774             samplesC = samples + channel;
775
776             if (avctx->codec->id == CODEC_ID_ADPCM_EA_R1) {
777                 current_sample  = (int16_t)bytestream_get_le16(&srcC);
778                 previous_sample = (int16_t)bytestream_get_le16(&srcC);
779             } else {
780                 current_sample  = c->status[channel].predictor;
781                 previous_sample = c->status[channel].prev_sample;
782             }
783
784             for (count1=0; count1<samples_in_chunk; count1++) {
785                 if (*srcC == 0xEE) {  /* only seen in R2 and R3 */
786                     srcC++;
787                     if (srcC > src_end - 30*2) break;
788                     current_sample  = (int16_t)bytestream_get_be16(&srcC);
789                     previous_sample = (int16_t)bytestream_get_be16(&srcC);
790
791                     for (count2=0; count2<28; count2++) {
792                         *samplesC = (int16_t)bytestream_get_be16(&srcC);
793                         samplesC += avctx->channels;
794                     }
795                 } else {
796                     coeff1 = ea_adpcm_table[ *srcC>>4     ];
797                     coeff2 = ea_adpcm_table[(*srcC>>4) + 4];
798                     shift = (*srcC++ & 0x0F) + 8;
799
800                     if (srcC > src_end - 14) break;
801                     for (count2=0; count2<28; count2++) {
802                         if (count2 & 1)
803                             next_sample = (int32_t)((*srcC++ & 0x0F) << 28) >> shift;
804                         else
805                             next_sample = (int32_t)((*srcC   & 0xF0) << 24) >> shift;
806
807                         next_sample += (current_sample  * coeff1) +
808                                        (previous_sample * coeff2);
809                         next_sample = av_clip_int16(next_sample >> 8);
810
811                         previous_sample = current_sample;
812                         current_sample  = next_sample;
813                         *samplesC = current_sample;
814                         samplesC += avctx->channels;
815                     }
816                 }
817             }
818
819             if (avctx->codec->id != CODEC_ID_ADPCM_EA_R1) {
820                 c->status[channel].predictor   = current_sample;
821                 c->status[channel].prev_sample = previous_sample;
822             }
823         }
824
825         src = src + buf_size - (4 + 4*avctx->channels);
826         samples += 28 * samples_in_chunk * avctx->channels;
827         break;
828     }
829     case CODEC_ID_ADPCM_EA_XAS:
830         if (samples_end-samples < 32*4*avctx->channels
831             || buf_size < (4+15)*4*avctx->channels) {
832             src += buf_size;
833             break;
834         }
835         for (channel=0; channel<avctx->channels; channel++) {
836             int coeff[2][4], shift[4];
837             short *s2, *s = &samples[channel];
838             for (n=0; n<4; n++, s+=32*avctx->channels) {
839                 for (i=0; i<2; i++)
840                     coeff[i][n] = ea_adpcm_table[(src[0]&0x0F)+4*i];
841                 shift[n] = (src[2]&0x0F) + 8;
842                 for (s2=s, i=0; i<2; i++, src+=2, s2+=avctx->channels)
843                     s2[0] = (src[0]&0xF0) + (src[1]<<8);
844             }
845
846             for (m=2; m<32; m+=2) {
847                 s = &samples[m*avctx->channels + channel];
848                 for (n=0; n<4; n++, src++, s+=32*avctx->channels) {
849                     for (s2=s, i=0; i<8; i+=4, s2+=avctx->channels) {
850                         int level = (int32_t)((*src & (0xF0>>i)) << (24+i)) >> shift[n];
851                         int pred  = s2[-1*avctx->channels] * coeff[0][n]
852                                   + s2[-2*avctx->channels] * coeff[1][n];
853                         s2[0] = av_clip_int16((level + pred + 0x80) >> 8);
854                     }
855                 }
856             }
857         }
858         samples += 32*4*avctx->channels;
859         break;
860     case CODEC_ID_ADPCM_IMA_AMV:
861     case CODEC_ID_ADPCM_IMA_SMJPEG:
862         c->status[0].predictor = (int16_t)bytestream_get_le16(&src);
863         c->status[0].step_index = bytestream_get_le16(&src);
864
865         if (avctx->codec->id == CODEC_ID_ADPCM_IMA_AMV)
866             src+=4;
867
868         while (src < buf + buf_size) {
869             char hi, lo;
870             lo = *src & 0x0F;
871             hi = *src >> 4;
872
873             if (avctx->codec->id == CODEC_ID_ADPCM_IMA_AMV)
874                 FFSWAP(char, hi, lo);
875
876             *samples++ = adpcm_ima_expand_nibble(&c->status[0],
877                 lo, 3);
878             *samples++ = adpcm_ima_expand_nibble(&c->status[0],
879                 hi, 3);
880             src++;
881         }
882         break;
883     case CODEC_ID_ADPCM_CT:
884         while (src < buf + buf_size) {
885             uint8_t v = *src++;
886             *samples++ = adpcm_ct_expand_nibble(&c->status[0 ], v >> 4  );
887             *samples++ = adpcm_ct_expand_nibble(&c->status[st], v & 0x0F);
888         }
889         break;
890     case CODEC_ID_ADPCM_SBPRO_4:
891     case CODEC_ID_ADPCM_SBPRO_3:
892     case CODEC_ID_ADPCM_SBPRO_2:
893         if (!c->status[0].step_index) {
894             /* the first byte is a raw sample */
895             *samples++ = 128 * (*src++ - 0x80);
896             if (st)
897               *samples++ = 128 * (*src++ - 0x80);
898             c->status[0].step_index = 1;
899         }
900         if (avctx->codec->id == CODEC_ID_ADPCM_SBPRO_4) {
901             while (src < buf + buf_size) {
902                 *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
903                     src[0] >> 4, 4, 0);
904                 *samples++ = adpcm_sbpro_expand_nibble(&c->status[st],
905                     src[0] & 0x0F, 4, 0);
906                 src++;
907             }
908         } else if (avctx->codec->id == CODEC_ID_ADPCM_SBPRO_3) {
909             while (src < buf + buf_size && samples + 2 < samples_end) {
910                 *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
911                      src[0] >> 5        , 3, 0);
912                 *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
913                     (src[0] >> 2) & 0x07, 3, 0);
914                 *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
915                     src[0] & 0x03, 2, 0);
916                 src++;
917             }
918         } else {
919             while (src < buf + buf_size && samples + 3 < samples_end) {
920                 *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
921                      src[0] >> 6        , 2, 2);
922                 *samples++ = adpcm_sbpro_expand_nibble(&c->status[st],
923                     (src[0] >> 4) & 0x03, 2, 2);
924                 *samples++ = adpcm_sbpro_expand_nibble(&c->status[0],
925                     (src[0] >> 2) & 0x03, 2, 2);
926                 *samples++ = adpcm_sbpro_expand_nibble(&c->status[st],
927                     src[0] & 0x03, 2, 2);
928                 src++;
929             }
930         }
931         break;
932     case CODEC_ID_ADPCM_SWF:
933     {
934         GetBitContext gb;
935         const int *table;
936         int k0, signmask, nb_bits, count;
937         int size = buf_size*8;
938
939         init_get_bits(&gb, buf, size);
940
941         //read bits & initial values
942         nb_bits = get_bits(&gb, 2)+2;
943         //av_log(NULL,AV_LOG_INFO,"nb_bits: %d\n", nb_bits);
944         table = swf_index_tables[nb_bits-2];
945         k0 = 1 << (nb_bits-2);
946         signmask = 1 << (nb_bits-1);
947
948         while (get_bits_count(&gb) <= size - 22*avctx->channels) {
949             for (i = 0; i < avctx->channels; i++) {
950                 *samples++ = c->status[i].predictor = get_sbits(&gb, 16);
951                 c->status[i].step_index = get_bits(&gb, 6);
952             }
953
954             for (count = 0; get_bits_count(&gb) <= size - nb_bits*avctx->channels && count < 4095; count++) {
955                 int i;
956
957                 for (i = 0; i < avctx->channels; i++) {
958                     // similar to IMA adpcm
959                     int delta = get_bits(&gb, nb_bits);
960                     int step = ff_adpcm_step_table[c->status[i].step_index];
961                     long vpdiff = 0; // vpdiff = (delta+0.5)*step/4
962                     int k = k0;
963
964                     do {
965                         if (delta & k)
966                             vpdiff += step;
967                         step >>= 1;
968                         k >>= 1;
969                     } while(k);
970                     vpdiff += step;
971
972                     if (delta & signmask)
973                         c->status[i].predictor -= vpdiff;
974                     else
975                         c->status[i].predictor += vpdiff;
976
977                     c->status[i].step_index += table[delta & (~signmask)];
978
979                     c->status[i].step_index = av_clip(c->status[i].step_index, 0, 88);
980                     c->status[i].predictor = av_clip_int16(c->status[i].predictor);
981
982                     *samples++ = c->status[i].predictor;
983                     if (samples >= samples_end) {
984                         av_log(avctx, AV_LOG_ERROR, "allocated output buffer is too small\n");
985                         return -1;
986                     }
987                 }
988             }
989         }
990         src += buf_size;
991         break;
992     }
993     case CODEC_ID_ADPCM_YAMAHA:
994         while (src < buf + buf_size) {
995             uint8_t v = *src++;
996             *samples++ = adpcm_yamaha_expand_nibble(&c->status[0 ], v & 0x0F);
997             *samples++ = adpcm_yamaha_expand_nibble(&c->status[st], v >> 4  );
998         }
999         break;
1000     case CODEC_ID_ADPCM_THP:
1001     {
1002         int table[2][16];
1003         unsigned int samplecnt;
1004         int prev[2][2];
1005         int ch;
1006
1007         if (buf_size < 80) {
1008             av_log(avctx, AV_LOG_ERROR, "frame too small\n");
1009             return -1;
1010         }
1011
1012         src+=4;
1013         samplecnt = bytestream_get_be32(&src);
1014
1015         for (i = 0; i < 32; i++)
1016             table[0][i] = (int16_t)bytestream_get_be16(&src);
1017
1018         /* Initialize the previous sample.  */
1019         for (i = 0; i < 4; i++)
1020             prev[0][i] = (int16_t)bytestream_get_be16(&src);
1021
1022         if (samplecnt >= (samples_end - samples) /  (st + 1)) {
1023             av_log(avctx, AV_LOG_ERROR, "allocated output buffer is too small\n");
1024             return -1;
1025         }
1026
1027         for (ch = 0; ch <= st; ch++) {
1028             samples = (unsigned short *) data + ch;
1029
1030             /* Read in every sample for this channel.  */
1031             for (i = 0; i < samplecnt / 14; i++) {
1032                 int index = (*src >> 4) & 7;
1033                 unsigned int exp = 28 - (*src++ & 15);
1034                 int factor1 = table[ch][index * 2];
1035                 int factor2 = table[ch][index * 2 + 1];
1036
1037                 /* Decode 14 samples.  */
1038                 for (n = 0; n < 14; n++) {
1039                     int32_t sampledat;
1040                     if(n&1) sampledat=  *src++    <<28;
1041                     else    sampledat= (*src&0xF0)<<24;
1042
1043                     sampledat = ((prev[ch][0]*factor1
1044                                 + prev[ch][1]*factor2) >> 11) + (sampledat>>exp);
1045                     *samples = av_clip_int16(sampledat);
1046                     prev[ch][1] = prev[ch][0];
1047                     prev[ch][0] = *samples++;
1048
1049                     /* In case of stereo, skip one sample, this sample
1050                        is for the other channel.  */
1051                     samples += st;
1052                 }
1053             }
1054         }
1055
1056         /* In the previous loop, in case stereo is used, samples is
1057            increased exactly one time too often.  */
1058         samples -= st;
1059         break;
1060     }
1061
1062     default:
1063         return -1;
1064     }
1065     *data_size = (uint8_t *)samples - (uint8_t *)data;
1066     return src - buf;
1067 }
1068
1069
1070 #define ADPCM_DECODER(id_, name_, long_name_)               \
1071 AVCodec ff_ ## name_ ## _decoder = {                        \
1072     .name           = #name_,                               \
1073     .type           = AVMEDIA_TYPE_AUDIO,                   \
1074     .id             = id_,                                  \
1075     .priv_data_size = sizeof(ADPCMDecodeContext),           \
1076     .init           = adpcm_decode_init,                    \
1077     .decode         = adpcm_decode_frame,                   \
1078     .long_name      = NULL_IF_CONFIG_SMALL(long_name_),     \
1079 }
1080
1081 /* Note: Do not forget to add new entries to the Makefile as well. */
1082 ADPCM_DECODER(CODEC_ID_ADPCM_4XM, adpcm_4xm, "ADPCM 4X Movie");
1083 ADPCM_DECODER(CODEC_ID_ADPCM_CT, adpcm_ct, "ADPCM Creative Technology");
1084 ADPCM_DECODER(CODEC_ID_ADPCM_EA, adpcm_ea, "ADPCM Electronic Arts");
1085 ADPCM_DECODER(CODEC_ID_ADPCM_EA_MAXIS_XA, adpcm_ea_maxis_xa, "ADPCM Electronic Arts Maxis CDROM XA");
1086 ADPCM_DECODER(CODEC_ID_ADPCM_EA_R1, adpcm_ea_r1, "ADPCM Electronic Arts R1");
1087 ADPCM_DECODER(CODEC_ID_ADPCM_EA_R2, adpcm_ea_r2, "ADPCM Electronic Arts R2");
1088 ADPCM_DECODER(CODEC_ID_ADPCM_EA_R3, adpcm_ea_r3, "ADPCM Electronic Arts R3");
1089 ADPCM_DECODER(CODEC_ID_ADPCM_EA_XAS, adpcm_ea_xas, "ADPCM Electronic Arts XAS");
1090 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_AMV, adpcm_ima_amv, "ADPCM IMA AMV");
1091 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_DK3, adpcm_ima_dk3, "ADPCM IMA Duck DK3");
1092 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_DK4, adpcm_ima_dk4, "ADPCM IMA Duck DK4");
1093 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_EA_EACS, adpcm_ima_ea_eacs, "ADPCM IMA Electronic Arts EACS");
1094 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_EA_SEAD, adpcm_ima_ea_sead, "ADPCM IMA Electronic Arts SEAD");
1095 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_ISS, adpcm_ima_iss, "ADPCM IMA Funcom ISS");
1096 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_QT, adpcm_ima_qt, "ADPCM IMA QuickTime");
1097 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_SMJPEG, adpcm_ima_smjpeg, "ADPCM IMA Loki SDL MJPEG");
1098 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_WAV, adpcm_ima_wav, "ADPCM IMA WAV");
1099 ADPCM_DECODER(CODEC_ID_ADPCM_IMA_WS, adpcm_ima_ws, "ADPCM IMA Westwood");
1100 ADPCM_DECODER(CODEC_ID_ADPCM_MS, adpcm_ms, "ADPCM Microsoft");
1101 ADPCM_DECODER(CODEC_ID_ADPCM_SBPRO_2, adpcm_sbpro_2, "ADPCM Sound Blaster Pro 2-bit");
1102 ADPCM_DECODER(CODEC_ID_ADPCM_SBPRO_3, adpcm_sbpro_3, "ADPCM Sound Blaster Pro 2.6-bit");
1103 ADPCM_DECODER(CODEC_ID_ADPCM_SBPRO_4, adpcm_sbpro_4, "ADPCM Sound Blaster Pro 4-bit");
1104 ADPCM_DECODER(CODEC_ID_ADPCM_SWF, adpcm_swf, "ADPCM Shockwave Flash");
1105 ADPCM_DECODER(CODEC_ID_ADPCM_THP, adpcm_thp, "ADPCM Nintendo Gamecube THP");
1106 ADPCM_DECODER(CODEC_ID_ADPCM_XA, adpcm_xa, "ADPCM CDROM XA");
1107 ADPCM_DECODER(CODEC_ID_ADPCM_YAMAHA, adpcm_yamaha, "ADPCM Yamaha");