00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00045 #include "libavutil/lfg.h"
00046 #include "avcodec.h"
00047 #include "get_bits.h"
00048 #include "dsputil.h"
00049 #include "bytestream.h"
00050 #include "fft.h"
00051 #include "libavutil/audioconvert.h"
00052 #include "sinewin.h"
00053
00054 #include "cookdata.h"
00055
00056
00057 #define MONO 0x1000001
00058 #define STEREO 0x1000002
00059 #define JOINT_STEREO 0x1000003
00060 #define MC_COOK 0x2000000 //multichannel Cook, not supported
00061
00062 #define SUBBAND_SIZE 20
00063 #define MAX_SUBPACKETS 5
00064
00065 typedef struct {
00066 int *now;
00067 int *previous;
00068 } cook_gains;
00069
00070 typedef struct {
00071 int ch_idx;
00072 int size;
00073 int num_channels;
00074 int cookversion;
00075 int samples_per_frame;
00076 int subbands;
00077 int js_subband_start;
00078 int js_vlc_bits;
00079 int samples_per_channel;
00080 int log2_numvector_size;
00081 unsigned int channel_mask;
00082 VLC ccpl;
00083 int joint_stereo;
00084 int bits_per_subpacket;
00085 int bits_per_subpdiv;
00086 int total_subbands;
00087 int numvector_size;
00088
00089 float mono_previous_buffer1[1024];
00090 float mono_previous_buffer2[1024];
00092 cook_gains gains1;
00093 cook_gains gains2;
00094 int gain_1[9];
00095 int gain_2[9];
00096 int gain_3[9];
00097 int gain_4[9];
00098 } COOKSubpacket;
00099
00100 typedef struct cook {
00101
00102
00103
00104
00105 void (* scalar_dequant)(struct cook *q, int index, int quant_index,
00106 int* subband_coef_index, int* subband_coef_sign,
00107 float* mlt_p);
00108
00109 void (* decouple) (struct cook *q,
00110 COOKSubpacket *p,
00111 int subband,
00112 float f1, float f2,
00113 float *decode_buffer,
00114 float *mlt_buffer1, float *mlt_buffer2);
00115
00116 void (* imlt_window) (struct cook *q, float *buffer1,
00117 cook_gains *gains_ptr, float *previous_buffer);
00118
00119 void (* interpolate) (struct cook *q, float* buffer,
00120 int gain_index, int gain_index_next);
00121
00122 void (* saturate_output) (struct cook *q, int chan, float *out);
00123
00124 AVCodecContext* avctx;
00125 AVFrame frame;
00126 GetBitContext gb;
00127
00128 int nb_channels;
00129 int bit_rate;
00130 int sample_rate;
00131 int num_vectors;
00132 int samples_per_channel;
00133
00134 AVLFG random_state;
00135 int discarded_packets;
00136
00137
00138 FFTContext mdct_ctx;
00139 float* mlt_window;
00140
00141
00142 VLC envelope_quant_index[13];
00143 VLC sqvh[7];
00144
00145
00146 int gain_size_factor;
00147 float gain_table[23];
00148
00149
00150
00151 uint8_t* decoded_bytes_buffer;
00152 DECLARE_ALIGNED(32, float, mono_mdct_output)[2048];
00153 float decode_buffer_1[1024];
00154 float decode_buffer_2[1024];
00155 float decode_buffer_0[1060];
00156
00157 const float *cplscales[5];
00158 int num_subpackets;
00159 COOKSubpacket subpacket[MAX_SUBPACKETS];
00160 } COOKContext;
00161
00162 static float pow2tab[127];
00163 static float rootpow2tab[127];
00164
00165
00166
00167
00168 static av_cold void init_pow2table(void){
00169 int i;
00170 for (i=-63 ; i<64 ; i++){
00171 pow2tab[63+i]= pow(2, i);
00172 rootpow2tab[63+i]=sqrt(pow(2, i));
00173 }
00174 }
00175
00176
00177 static av_cold void init_gain_table(COOKContext *q) {
00178 int i;
00179 q->gain_size_factor = q->samples_per_channel/8;
00180 for (i=0 ; i<23 ; i++) {
00181 q->gain_table[i] = pow(pow2tab[i+52] ,
00182 (1.0/(double)q->gain_size_factor));
00183 }
00184 }
00185
00186
00187 static av_cold int init_cook_vlc_tables(COOKContext *q) {
00188 int i, result;
00189
00190 result = 0;
00191 for (i=0 ; i<13 ; i++) {
00192 result |= init_vlc (&q->envelope_quant_index[i], 9, 24,
00193 envelope_quant_index_huffbits[i], 1, 1,
00194 envelope_quant_index_huffcodes[i], 2, 2, 0);
00195 }
00196 av_log(q->avctx,AV_LOG_DEBUG,"sqvh VLC init\n");
00197 for (i=0 ; i<7 ; i++) {
00198 result |= init_vlc (&q->sqvh[i], vhvlcsize_tab[i], vhsize_tab[i],
00199 cvh_huffbits[i], 1, 1,
00200 cvh_huffcodes[i], 2, 2, 0);
00201 }
00202
00203 for(i=0;i<q->num_subpackets;i++){
00204 if (q->subpacket[i].joint_stereo==1){
00205 result |= init_vlc (&q->subpacket[i].ccpl, 6, (1<<q->subpacket[i].js_vlc_bits)-1,
00206 ccpl_huffbits[q->subpacket[i].js_vlc_bits-2], 1, 1,
00207 ccpl_huffcodes[q->subpacket[i].js_vlc_bits-2], 2, 2, 0);
00208 av_log(q->avctx,AV_LOG_DEBUG,"subpacket %i Joint-stereo VLC used.\n",i);
00209 }
00210 }
00211
00212 av_log(q->avctx,AV_LOG_DEBUG,"VLC tables initialized.\n");
00213 return result;
00214 }
00215
00216 static av_cold int init_cook_mlt(COOKContext *q) {
00217 int j, ret;
00218 int mlt_size = q->samples_per_channel;
00219
00220 if ((q->mlt_window = av_malloc(mlt_size * sizeof(*q->mlt_window))) == 0)
00221 return AVERROR(ENOMEM);
00222
00223
00224 ff_sine_window_init(q->mlt_window, mlt_size);
00225 for(j=0 ; j<mlt_size ; j++)
00226 q->mlt_window[j] *= sqrt(2.0 / q->samples_per_channel);
00227
00228
00229 if ((ret = ff_mdct_init(&q->mdct_ctx, av_log2(mlt_size)+1, 1, 1.0/32768.0))) {
00230 av_free(q->mlt_window);
00231 return ret;
00232 }
00233 av_log(q->avctx,AV_LOG_DEBUG,"MDCT initialized, order = %d.\n",
00234 av_log2(mlt_size)+1);
00235
00236 return 0;
00237 }
00238
00239 static const float *maybe_reformat_buffer32 (COOKContext *q, const float *ptr, int n)
00240 {
00241 if (1)
00242 return ptr;
00243 }
00244
00245 static av_cold void init_cplscales_table (COOKContext *q) {
00246 int i;
00247 for (i=0;i<5;i++)
00248 q->cplscales[i] = maybe_reformat_buffer32 (q, cplscales[i], (1<<(i+2))-1);
00249 }
00250
00251
00252
00253 #define DECODE_BYTES_PAD1(bytes) (3 - ((bytes)+3) % 4)
00254 #define DECODE_BYTES_PAD2(bytes) ((bytes) % 4 + DECODE_BYTES_PAD1(2 * (bytes)))
00255
00277 static inline int decode_bytes(const uint8_t* inbuffer, uint8_t* out, int bytes){
00278 static const uint32_t tab[4] = {
00279 AV_BE2NE32C(0x37c511f2), AV_BE2NE32C(0xf237c511),
00280 AV_BE2NE32C(0x11f237c5), AV_BE2NE32C(0xc511f237),
00281 };
00282 int i, off;
00283 uint32_t c;
00284 const uint32_t* buf;
00285 uint32_t* obuf = (uint32_t*) out;
00286
00287
00288
00289
00290
00291
00292 off = (intptr_t)inbuffer & 3;
00293 buf = (const uint32_t*) (inbuffer - off);
00294 c = tab[off];
00295 bytes += 3 + off;
00296 for (i = 0; i < bytes/4; i++)
00297 obuf[i] = c ^ buf[i];
00298
00299 return off;
00300 }
00301
00306 static av_cold int cook_decode_close(AVCodecContext *avctx)
00307 {
00308 int i;
00309 COOKContext *q = avctx->priv_data;
00310 av_log(avctx,AV_LOG_DEBUG, "Deallocating memory.\n");
00311
00312
00313 av_free(q->mlt_window);
00314 av_free(q->decoded_bytes_buffer);
00315
00316
00317 ff_mdct_end(&q->mdct_ctx);
00318
00319
00320 for (i=0 ; i<13 ; i++) {
00321 free_vlc(&q->envelope_quant_index[i]);
00322 }
00323 for (i=0 ; i<7 ; i++) {
00324 free_vlc(&q->sqvh[i]);
00325 }
00326 for (i=0 ; i<q->num_subpackets ; i++) {
00327 free_vlc(&q->subpacket[i].ccpl);
00328 }
00329
00330 av_log(avctx,AV_LOG_DEBUG,"Memory deallocated.\n");
00331
00332 return 0;
00333 }
00334
00342 static void decode_gain_info(GetBitContext *gb, int *gaininfo)
00343 {
00344 int i, n;
00345
00346 while (get_bits1(gb)) {}
00347 n = get_bits_count(gb) - 1;
00348
00349 i = 0;
00350 while (n--) {
00351 int index = get_bits(gb, 3);
00352 int gain = get_bits1(gb) ? get_bits(gb, 4) - 7 : -1;
00353
00354 while (i <= index) gaininfo[i++] = gain;
00355 }
00356 while (i <= 8) gaininfo[i++] = 0;
00357 }
00358
00366 static void decode_envelope(COOKContext *q, COOKSubpacket *p, int* quant_index_table) {
00367 int i,j, vlc_index;
00368
00369 quant_index_table[0]= get_bits(&q->gb,6) - 6;
00370
00371 for (i=1 ; i < p->total_subbands ; i++){
00372 vlc_index=i;
00373 if (i >= p->js_subband_start * 2) {
00374 vlc_index-=p->js_subband_start;
00375 } else {
00376 vlc_index/=2;
00377 if(vlc_index < 1) vlc_index = 1;
00378 }
00379 if (vlc_index>13) vlc_index = 13;
00380
00381 j = get_vlc2(&q->gb, q->envelope_quant_index[vlc_index-1].table,
00382 q->envelope_quant_index[vlc_index-1].bits,2);
00383 quant_index_table[i] = quant_index_table[i-1] + j - 12;
00384 }
00385 }
00386
00396 static void categorize(COOKContext *q, COOKSubpacket *p, int* quant_index_table,
00397 int* category, int* category_index){
00398 int exp_idx, bias, tmpbias1, tmpbias2, bits_left, num_bits, index, v, i, j;
00399 int exp_index2[102];
00400 int exp_index1[102];
00401
00402 int tmp_categorize_array[128*2];
00403 int tmp_categorize_array1_idx=p->numvector_size;
00404 int tmp_categorize_array2_idx=p->numvector_size;
00405
00406 bits_left = p->bits_per_subpacket - get_bits_count(&q->gb);
00407
00408 if(bits_left > q->samples_per_channel) {
00409 bits_left = q->samples_per_channel +
00410 ((bits_left - q->samples_per_channel)*5)/8;
00411
00412 }
00413
00414 memset(&exp_index1, 0, sizeof(exp_index1));
00415 memset(&exp_index2, 0, sizeof(exp_index2));
00416 memset(&tmp_categorize_array, 0, sizeof(tmp_categorize_array));
00417
00418 bias=-32;
00419
00420
00421 for (i=32 ; i>0 ; i=i/2){
00422 num_bits = 0;
00423 index = 0;
00424 for (j=p->total_subbands ; j>0 ; j--){
00425 exp_idx = av_clip((i - quant_index_table[index] + bias) / 2, 0, 7);
00426 index++;
00427 num_bits+=expbits_tab[exp_idx];
00428 }
00429 if(num_bits >= bits_left - 32){
00430 bias+=i;
00431 }
00432 }
00433
00434
00435 num_bits=0;
00436 for (i=0 ; i<p->total_subbands ; i++) {
00437 exp_idx = av_clip((bias - quant_index_table[i]) / 2, 0, 7);
00438 num_bits += expbits_tab[exp_idx];
00439 exp_index1[i] = exp_idx;
00440 exp_index2[i] = exp_idx;
00441 }
00442 tmpbias1 = tmpbias2 = num_bits;
00443
00444 for (j = 1 ; j < p->numvector_size ; j++) {
00445 if (tmpbias1 + tmpbias2 > 2*bits_left) {
00446 int max = -999999;
00447 index=-1;
00448 for (i=0 ; i<p->total_subbands ; i++){
00449 if (exp_index1[i] < 7) {
00450 v = (-2*exp_index1[i]) - quant_index_table[i] + bias;
00451 if ( v >= max) {
00452 max = v;
00453 index = i;
00454 }
00455 }
00456 }
00457 if(index==-1)break;
00458 tmp_categorize_array[tmp_categorize_array1_idx++] = index;
00459 tmpbias1 -= expbits_tab[exp_index1[index]] -
00460 expbits_tab[exp_index1[index]+1];
00461 ++exp_index1[index];
00462 } else {
00463 int min = 999999;
00464 index=-1;
00465 for (i=0 ; i<p->total_subbands ; i++){
00466 if(exp_index2[i] > 0){
00467 v = (-2*exp_index2[i])-quant_index_table[i]+bias;
00468 if ( v < min) {
00469 min = v;
00470 index = i;
00471 }
00472 }
00473 }
00474 if(index == -1)break;
00475 tmp_categorize_array[--tmp_categorize_array2_idx] = index;
00476 tmpbias2 -= expbits_tab[exp_index2[index]] -
00477 expbits_tab[exp_index2[index]-1];
00478 --exp_index2[index];
00479 }
00480 }
00481
00482 for(i=0 ; i<p->total_subbands ; i++)
00483 category[i] = exp_index2[i];
00484
00485 for(i=0 ; i<p->numvector_size-1 ; i++)
00486 category_index[i] = tmp_categorize_array[tmp_categorize_array2_idx++];
00487
00488 }
00489
00490
00499 static inline void expand_category(COOKContext *q, int* category,
00500 int* category_index){
00501 int i;
00502 for(i=0 ; i<q->num_vectors ; i++){
00503 ++category[category_index[i]];
00504 }
00505 }
00506
00518 static void scalar_dequant_float(COOKContext *q, int index, int quant_index,
00519 int* subband_coef_index, int* subband_coef_sign,
00520 float* mlt_p){
00521 int i;
00522 float f1;
00523
00524 for(i=0 ; i<SUBBAND_SIZE ; i++) {
00525 if (subband_coef_index[i]) {
00526 f1 = quant_centroid_tab[index][subband_coef_index[i]];
00527 if (subband_coef_sign[i]) f1 = -f1;
00528 } else {
00529
00530 f1 = dither_tab[index];
00531 if (av_lfg_get(&q->random_state) < 0x80000000) f1 = -f1;
00532 }
00533 mlt_p[i] = f1 * rootpow2tab[quant_index+63];
00534 }
00535 }
00545 static int unpack_SQVH(COOKContext *q, COOKSubpacket *p, int category, int* subband_coef_index,
00546 int* subband_coef_sign) {
00547 int i,j;
00548 int vlc, vd ,tmp, result;
00549
00550 vd = vd_tab[category];
00551 result = 0;
00552 for(i=0 ; i<vpr_tab[category] ; i++){
00553 vlc = get_vlc2(&q->gb, q->sqvh[category].table, q->sqvh[category].bits, 3);
00554 if (p->bits_per_subpacket < get_bits_count(&q->gb)){
00555 vlc = 0;
00556 result = 1;
00557 }
00558 for(j=vd-1 ; j>=0 ; j--){
00559 tmp = (vlc * invradix_tab[category])/0x100000;
00560 subband_coef_index[vd*i+j] = vlc - tmp * (kmax_tab[category]+1);
00561 vlc = tmp;
00562 }
00563 for(j=0 ; j<vd ; j++){
00564 if (subband_coef_index[i*vd + j]) {
00565 if(get_bits_count(&q->gb) < p->bits_per_subpacket){
00566 subband_coef_sign[i*vd+j] = get_bits1(&q->gb);
00567 } else {
00568 result=1;
00569 subband_coef_sign[i*vd+j]=0;
00570 }
00571 } else {
00572 subband_coef_sign[i*vd+j]=0;
00573 }
00574 }
00575 }
00576 return result;
00577 }
00578
00579
00590 static void decode_vectors(COOKContext* q, COOKSubpacket* p, int* category,
00591 int *quant_index_table, float* mlt_buffer){
00592
00593
00594 int subband_coef_index[SUBBAND_SIZE];
00595
00596
00597 int subband_coef_sign[SUBBAND_SIZE];
00598 int band, j;
00599 int index=0;
00600
00601 for(band=0 ; band<p->total_subbands ; band++){
00602 index = category[band];
00603 if(category[band] < 7){
00604 if(unpack_SQVH(q, p, category[band], subband_coef_index, subband_coef_sign)){
00605 index=7;
00606 for(j=0 ; j<p->total_subbands ; j++) category[band+j]=7;
00607 }
00608 }
00609 if(index>=7) {
00610 memset(subband_coef_index, 0, sizeof(subband_coef_index));
00611 memset(subband_coef_sign, 0, sizeof(subband_coef_sign));
00612 }
00613 q->scalar_dequant(q, index, quant_index_table[band],
00614 subband_coef_index, subband_coef_sign,
00615 &mlt_buffer[band * SUBBAND_SIZE]);
00616 }
00617
00618 if(p->total_subbands*SUBBAND_SIZE >= q->samples_per_channel){
00619 return;
00620 }
00621 }
00622
00623
00631 static void mono_decode(COOKContext *q, COOKSubpacket *p, float* mlt_buffer) {
00632
00633 int category_index[128];
00634 int quant_index_table[102];
00635 int category[128];
00636
00637 memset(&category, 0, sizeof(category));
00638 memset(&category_index, 0, sizeof(category_index));
00639
00640 decode_envelope(q, p, quant_index_table);
00641 q->num_vectors = get_bits(&q->gb,p->log2_numvector_size);
00642 categorize(q, p, quant_index_table, category, category_index);
00643 expand_category(q, category, category_index);
00644 decode_vectors(q, p, category, quant_index_table, mlt_buffer);
00645 }
00646
00647
00657 static void interpolate_float(COOKContext *q, float* buffer,
00658 int gain_index, int gain_index_next){
00659 int i;
00660 float fc1, fc2;
00661 fc1 = pow2tab[gain_index+63];
00662
00663 if(gain_index == gain_index_next){
00664 for(i=0 ; i<q->gain_size_factor ; i++){
00665 buffer[i]*=fc1;
00666 }
00667 } else {
00668 fc2 = q->gain_table[11 + (gain_index_next-gain_index)];
00669 for(i=0 ; i<q->gain_size_factor ; i++){
00670 buffer[i]*=fc1;
00671 fc1*=fc2;
00672 }
00673 }
00674 }
00675
00685 static void imlt_window_float (COOKContext *q, float *inbuffer,
00686 cook_gains *gains_ptr, float *previous_buffer)
00687 {
00688 const float fc = pow2tab[gains_ptr->previous[0] + 63];
00689 int i;
00690
00691
00692
00693
00694
00695
00696
00697 for(i = 0; i < q->samples_per_channel; i++){
00698 inbuffer[i] = inbuffer[i] * fc * q->mlt_window[i] -
00699 previous_buffer[i] * q->mlt_window[q->samples_per_channel - 1 - i];
00700 }
00701 }
00702
00715 static void imlt_gain(COOKContext *q, float *inbuffer,
00716 cook_gains *gains_ptr, float* previous_buffer)
00717 {
00718 float *buffer0 = q->mono_mdct_output;
00719 float *buffer1 = q->mono_mdct_output + q->samples_per_channel;
00720 int i;
00721
00722
00723 q->mdct_ctx.imdct_calc(&q->mdct_ctx, q->mono_mdct_output, inbuffer);
00724
00725 q->imlt_window (q, buffer1, gains_ptr, previous_buffer);
00726
00727
00728 for (i = 0; i < 8; i++) {
00729 if (gains_ptr->now[i] || gains_ptr->now[i + 1])
00730 q->interpolate(q, &buffer1[q->gain_size_factor * i],
00731 gains_ptr->now[i], gains_ptr->now[i + 1]);
00732 }
00733
00734
00735 memcpy(previous_buffer, buffer0,
00736 q->samples_per_channel * sizeof(*previous_buffer));
00737 }
00738
00739
00747 static void decouple_info(COOKContext *q, COOKSubpacket *p, int *decouple_tab)
00748 {
00749 int i;
00750 int vlc = get_bits1(&q->gb);
00751 int start = cplband[p->js_subband_start];
00752 int end = cplband[p->subbands-1];
00753 int length = end - start + 1;
00754
00755 if (start > end)
00756 return;
00757
00758 if (vlc) {
00759 for (i = 0; i < length; i++)
00760 decouple_tab[start + i] = get_vlc2(&q->gb, p->ccpl.table, p->ccpl.bits, 2);
00761 } else {
00762 for (i = 0; i < length; i++)
00763 decouple_tab[start + i] = get_bits(&q->gb, p->js_vlc_bits);
00764 }
00765 }
00766
00767
00768
00769
00770
00771
00772
00773
00774
00775
00776
00777
00778 static void decouple_float (COOKContext *q,
00779 COOKSubpacket *p,
00780 int subband,
00781 float f1, float f2,
00782 float *decode_buffer,
00783 float *mlt_buffer1, float *mlt_buffer2)
00784 {
00785 int j, tmp_idx;
00786 for (j=0 ; j<SUBBAND_SIZE ; j++) {
00787 tmp_idx = ((p->js_subband_start + subband)*SUBBAND_SIZE)+j;
00788 mlt_buffer1[SUBBAND_SIZE*subband + j] = f1 * decode_buffer[tmp_idx];
00789 mlt_buffer2[SUBBAND_SIZE*subband + j] = f2 * decode_buffer[tmp_idx];
00790 }
00791 }
00792
00801 static void joint_decode(COOKContext *q, COOKSubpacket *p, float* mlt_buffer1,
00802 float* mlt_buffer2) {
00803 int i,j;
00804 int decouple_tab[SUBBAND_SIZE];
00805 float *decode_buffer = q->decode_buffer_0;
00806 int idx, cpl_tmp;
00807 float f1,f2;
00808 const float* cplscale;
00809
00810 memset(decouple_tab, 0, sizeof(decouple_tab));
00811 memset(decode_buffer, 0, sizeof(q->decode_buffer_0));
00812
00813
00814 memset(mlt_buffer1, 0, 1024 * sizeof(*mlt_buffer1));
00815 memset(mlt_buffer2, 0, 1024 * sizeof(*mlt_buffer2));
00816 decouple_info(q, p, decouple_tab);
00817 mono_decode(q, p, decode_buffer);
00818
00819
00820 for (i=0 ; i<p->js_subband_start ; i++) {
00821 for (j=0 ; j<SUBBAND_SIZE ; j++) {
00822 mlt_buffer1[i*20+j] = decode_buffer[i*40+j];
00823 mlt_buffer2[i*20+j] = decode_buffer[i*40+20+j];
00824 }
00825 }
00826
00827
00828
00829 idx = (1 << p->js_vlc_bits) - 1;
00830 for (i=p->js_subband_start ; i<p->subbands ; i++) {
00831 cpl_tmp = cplband[i];
00832 idx -=decouple_tab[cpl_tmp];
00833 cplscale = q->cplscales[p->js_vlc_bits-2];
00834 f1 = cplscale[decouple_tab[cpl_tmp]];
00835 f2 = cplscale[idx-1];
00836 q->decouple (q, p, i, f1, f2, decode_buffer, mlt_buffer1, mlt_buffer2);
00837 idx = (1 << p->js_vlc_bits) - 1;
00838 }
00839 }
00840
00850 static inline void
00851 decode_bytes_and_gain(COOKContext *q, COOKSubpacket *p, const uint8_t *inbuffer,
00852 cook_gains *gains_ptr)
00853 {
00854 int offset;
00855
00856 offset = decode_bytes(inbuffer, q->decoded_bytes_buffer,
00857 p->bits_per_subpacket/8);
00858 init_get_bits(&q->gb, q->decoded_bytes_buffer + offset,
00859 p->bits_per_subpacket);
00860 decode_gain_info(&q->gb, gains_ptr->now);
00861
00862
00863 FFSWAP(int *, gains_ptr->now, gains_ptr->previous);
00864 }
00865
00873 static void saturate_output_float(COOKContext *q, int chan, float *out)
00874 {
00875 int j;
00876 float *output = q->mono_mdct_output + q->samples_per_channel;
00877 for (j = 0; j < q->samples_per_channel; j++) {
00878 out[chan + q->nb_channels * j] = av_clipf(output[j], -1.0, 1.0);
00879 }
00880 }
00881
00895 static inline void
00896 mlt_compensate_output(COOKContext *q, float *decode_buffer,
00897 cook_gains *gains_ptr, float *previous_buffer,
00898 float *out, int chan)
00899 {
00900 imlt_gain(q, decode_buffer, gains_ptr, previous_buffer);
00901 if (out)
00902 q->saturate_output(q, chan, out);
00903 }
00904
00905
00914 static void decode_subpacket(COOKContext *q, COOKSubpacket *p,
00915 const uint8_t *inbuffer, float *outbuffer)
00916 {
00917 int sub_packet_size = p->size;
00918
00919
00920
00921
00922
00923 memset(q->decode_buffer_1,0,sizeof(q->decode_buffer_1));
00924 decode_bytes_and_gain(q, p, inbuffer, &p->gains1);
00925
00926 if (p->joint_stereo) {
00927 joint_decode(q, p, q->decode_buffer_1, q->decode_buffer_2);
00928 } else {
00929 mono_decode(q, p, q->decode_buffer_1);
00930
00931 if (p->num_channels == 2) {
00932 decode_bytes_and_gain(q, p, inbuffer + sub_packet_size/2, &p->gains2);
00933 mono_decode(q, p, q->decode_buffer_2);
00934 }
00935 }
00936
00937 mlt_compensate_output(q, q->decode_buffer_1, &p->gains1,
00938 p->mono_previous_buffer1, outbuffer, p->ch_idx);
00939
00940 if (p->num_channels == 2) {
00941 if (p->joint_stereo) {
00942 mlt_compensate_output(q, q->decode_buffer_2, &p->gains1,
00943 p->mono_previous_buffer2, outbuffer, p->ch_idx + 1);
00944 } else {
00945 mlt_compensate_output(q, q->decode_buffer_2, &p->gains2,
00946 p->mono_previous_buffer2, outbuffer, p->ch_idx + 1);
00947 }
00948 }
00949
00950 }
00951
00952
00959 static int cook_decode_frame(AVCodecContext *avctx, void *data,
00960 int *got_frame_ptr, AVPacket *avpkt)
00961 {
00962 const uint8_t *buf = avpkt->data;
00963 int buf_size = avpkt->size;
00964 COOKContext *q = avctx->priv_data;
00965 float *samples = NULL;
00966 int i, ret;
00967 int offset = 0;
00968 int chidx = 0;
00969
00970 if (buf_size < avctx->block_align)
00971 return buf_size;
00972
00973
00974 if (q->discarded_packets >= 2) {
00975 q->frame.nb_samples = q->samples_per_channel;
00976 if ((ret = avctx->get_buffer(avctx, &q->frame)) < 0) {
00977 av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
00978 return ret;
00979 }
00980 samples = (float *)q->frame.data[0];
00981 }
00982
00983
00984 q->subpacket[0].size = avctx->block_align;
00985
00986 for(i=1;i<q->num_subpackets;i++){
00987 q->subpacket[i].size = 2 * buf[avctx->block_align - q->num_subpackets + i];
00988 q->subpacket[0].size -= q->subpacket[i].size + 1;
00989 if (q->subpacket[0].size < 0) {
00990 av_log(avctx,AV_LOG_DEBUG,"frame subpacket size total > avctx->block_align!\n");
00991 return AVERROR_INVALIDDATA;
00992 }
00993 }
00994
00995
00996 for(i=0;i<q->num_subpackets;i++){
00997 q->subpacket[i].bits_per_subpacket = (q->subpacket[i].size*8)>>q->subpacket[i].bits_per_subpdiv;
00998 q->subpacket[i].ch_idx = chidx;
00999 av_log(avctx,AV_LOG_DEBUG,"subpacket[%i] size %i js %i %i block_align %i\n",i,q->subpacket[i].size,q->subpacket[i].joint_stereo,offset,avctx->block_align);
01000 decode_subpacket(q, &q->subpacket[i], buf + offset, samples);
01001 offset += q->subpacket[i].size;
01002 chidx += q->subpacket[i].num_channels;
01003 av_log(avctx,AV_LOG_DEBUG,"subpacket[%i] %i %i\n",i,q->subpacket[i].size * 8,get_bits_count(&q->gb));
01004 }
01005
01006
01007 if (q->discarded_packets < 2) {
01008 q->discarded_packets++;
01009 *got_frame_ptr = 0;
01010 return avctx->block_align;
01011 }
01012
01013 *got_frame_ptr = 1;
01014 *(AVFrame *)data = q->frame;
01015
01016 return avctx->block_align;
01017 }
01018
01019 #ifdef DEBUG
01020 static void dump_cook_context(COOKContext *q)
01021 {
01022
01023 #define PRINT(a,b) av_log(q->avctx,AV_LOG_ERROR," %s = %d\n", a, b);
01024 av_log(q->avctx,AV_LOG_ERROR,"COOKextradata\n");
01025 av_log(q->avctx,AV_LOG_ERROR,"cookversion=%x\n",q->subpacket[0].cookversion);
01026 if (q->subpacket[0].cookversion > STEREO) {
01027 PRINT("js_subband_start",q->subpacket[0].js_subband_start);
01028 PRINT("js_vlc_bits",q->subpacket[0].js_vlc_bits);
01029 }
01030 av_log(q->avctx,AV_LOG_ERROR,"COOKContext\n");
01031 PRINT("nb_channels",q->nb_channels);
01032 PRINT("bit_rate",q->bit_rate);
01033 PRINT("sample_rate",q->sample_rate);
01034 PRINT("samples_per_channel",q->subpacket[0].samples_per_channel);
01035 PRINT("samples_per_frame",q->subpacket[0].samples_per_frame);
01036 PRINT("subbands",q->subpacket[0].subbands);
01037 PRINT("js_subband_start",q->subpacket[0].js_subband_start);
01038 PRINT("log2_numvector_size",q->subpacket[0].log2_numvector_size);
01039 PRINT("numvector_size",q->subpacket[0].numvector_size);
01040 PRINT("total_subbands",q->subpacket[0].total_subbands);
01041 }
01042 #endif
01043
01044 static av_cold int cook_count_channels(unsigned int mask){
01045 int i;
01046 int channels = 0;
01047 for(i = 0;i<32;i++){
01048 if(mask & (1<<i))
01049 ++channels;
01050 }
01051 return channels;
01052 }
01053
01060 static av_cold int cook_decode_init(AVCodecContext *avctx)
01061 {
01062 COOKContext *q = avctx->priv_data;
01063 const uint8_t *edata_ptr = avctx->extradata;
01064 const uint8_t *edata_ptr_end = edata_ptr + avctx->extradata_size;
01065 int extradata_size = avctx->extradata_size;
01066 int s = 0;
01067 unsigned int channel_mask = 0;
01068 int ret;
01069 q->avctx = avctx;
01070
01071
01072 if (extradata_size <= 0) {
01073 av_log(avctx,AV_LOG_ERROR,"Necessary extradata missing!\n");
01074 return AVERROR_INVALIDDATA;
01075 }
01076 av_log(avctx,AV_LOG_DEBUG,"codecdata_length=%d\n",avctx->extradata_size);
01077
01078
01079 q->sample_rate = avctx->sample_rate;
01080 q->nb_channels = avctx->channels;
01081 q->bit_rate = avctx->bit_rate;
01082
01083
01084 av_lfg_init(&q->random_state, 0);
01085
01086 while(edata_ptr < edata_ptr_end){
01087
01088
01089 if (extradata_size >= 8){
01090 q->subpacket[s].cookversion = bytestream_get_be32(&edata_ptr);
01091 q->subpacket[s].samples_per_frame = bytestream_get_be16(&edata_ptr);
01092 q->subpacket[s].subbands = bytestream_get_be16(&edata_ptr);
01093 extradata_size -= 8;
01094 }
01095 if (extradata_size >= 8) {
01096 bytestream_get_be32(&edata_ptr);
01097 q->subpacket[s].js_subband_start = bytestream_get_be16(&edata_ptr);
01098 q->subpacket[s].js_vlc_bits = bytestream_get_be16(&edata_ptr);
01099 extradata_size -= 8;
01100 }
01101
01102
01103 q->subpacket[s].samples_per_channel = q->subpacket[s].samples_per_frame / q->nb_channels;
01104 q->subpacket[s].bits_per_subpacket = avctx->block_align * 8;
01105
01106
01107 q->subpacket[s].log2_numvector_size = 5;
01108 q->subpacket[s].total_subbands = q->subpacket[s].subbands;
01109 q->subpacket[s].num_channels = 1;
01110
01111
01112
01113 av_log(avctx,AV_LOG_DEBUG,"subpacket[%i].cookversion=%x\n",s,q->subpacket[s].cookversion);
01114 q->subpacket[s].joint_stereo = 0;
01115 switch (q->subpacket[s].cookversion) {
01116 case MONO:
01117 if (q->nb_channels != 1) {
01118 av_log_ask_for_sample(avctx, "Container channels != 1.\n");
01119 return AVERROR_PATCHWELCOME;
01120 }
01121 av_log(avctx,AV_LOG_DEBUG,"MONO\n");
01122 break;
01123 case STEREO:
01124 if (q->nb_channels != 1) {
01125 q->subpacket[s].bits_per_subpdiv = 1;
01126 q->subpacket[s].num_channels = 2;
01127 }
01128 av_log(avctx,AV_LOG_DEBUG,"STEREO\n");
01129 break;
01130 case JOINT_STEREO:
01131 if (q->nb_channels != 2) {
01132 av_log_ask_for_sample(avctx, "Container channels != 2.\n");
01133 return AVERROR_PATCHWELCOME;
01134 }
01135 av_log(avctx,AV_LOG_DEBUG,"JOINT_STEREO\n");
01136 if (avctx->extradata_size >= 16){
01137 q->subpacket[s].total_subbands = q->subpacket[s].subbands + q->subpacket[s].js_subband_start;
01138 q->subpacket[s].joint_stereo = 1;
01139 q->subpacket[s].num_channels = 2;
01140 }
01141 if (q->subpacket[s].samples_per_channel > 256) {
01142 q->subpacket[s].log2_numvector_size = 6;
01143 }
01144 if (q->subpacket[s].samples_per_channel > 512) {
01145 q->subpacket[s].log2_numvector_size = 7;
01146 }
01147 break;
01148 case MC_COOK:
01149 av_log(avctx,AV_LOG_DEBUG,"MULTI_CHANNEL\n");
01150 if(extradata_size >= 4)
01151 channel_mask |= q->subpacket[s].channel_mask = bytestream_get_be32(&edata_ptr);
01152
01153 if(cook_count_channels(q->subpacket[s].channel_mask) > 1){
01154 q->subpacket[s].total_subbands = q->subpacket[s].subbands + q->subpacket[s].js_subband_start;
01155 q->subpacket[s].joint_stereo = 1;
01156 q->subpacket[s].num_channels = 2;
01157 q->subpacket[s].samples_per_channel = q->subpacket[s].samples_per_frame >> 1;
01158
01159 if (q->subpacket[s].samples_per_channel > 256) {
01160 q->subpacket[s].log2_numvector_size = 6;
01161 }
01162 if (q->subpacket[s].samples_per_channel > 512) {
01163 q->subpacket[s].log2_numvector_size = 7;
01164 }
01165 }else
01166 q->subpacket[s].samples_per_channel = q->subpacket[s].samples_per_frame;
01167
01168 break;
01169 default:
01170 av_log_ask_for_sample(avctx, "Unknown Cook version.\n");
01171 return AVERROR_PATCHWELCOME;
01172 }
01173
01174 if(s > 1 && q->subpacket[s].samples_per_channel != q->samples_per_channel) {
01175 av_log(avctx,AV_LOG_ERROR,"different number of samples per channel!\n");
01176 return AVERROR_INVALIDDATA;
01177 } else
01178 q->samples_per_channel = q->subpacket[0].samples_per_channel;
01179
01180
01181
01182 q->subpacket[s].numvector_size = (1 << q->subpacket[s].log2_numvector_size);
01183
01184
01185 if (q->subpacket[s].total_subbands > 53) {
01186 av_log_ask_for_sample(avctx, "total_subbands > 53\n");
01187 return AVERROR_PATCHWELCOME;
01188 }
01189
01190 if ((q->subpacket[s].js_vlc_bits > 6) || (q->subpacket[s].js_vlc_bits < 2*q->subpacket[s].joint_stereo)) {
01191 av_log(avctx,AV_LOG_ERROR,"js_vlc_bits = %d, only >= %d and <= 6 allowed!\n",
01192 q->subpacket[s].js_vlc_bits, 2*q->subpacket[s].joint_stereo);
01193 return AVERROR_INVALIDDATA;
01194 }
01195
01196 if (q->subpacket[s].subbands > 50) {
01197 av_log_ask_for_sample(avctx, "subbands > 50\n");
01198 return AVERROR_PATCHWELCOME;
01199 }
01200 q->subpacket[s].gains1.now = q->subpacket[s].gain_1;
01201 q->subpacket[s].gains1.previous = q->subpacket[s].gain_2;
01202 q->subpacket[s].gains2.now = q->subpacket[s].gain_3;
01203 q->subpacket[s].gains2.previous = q->subpacket[s].gain_4;
01204
01205 q->num_subpackets++;
01206 s++;
01207 if (s > MAX_SUBPACKETS) {
01208 av_log_ask_for_sample(avctx, "Too many subpackets > 5\n");
01209 return AVERROR_PATCHWELCOME;
01210 }
01211 }
01212
01213 init_pow2table();
01214 init_gain_table(q);
01215 init_cplscales_table(q);
01216
01217 if ((ret = init_cook_vlc_tables(q)))
01218 return ret;
01219
01220
01221 if(avctx->block_align >= UINT_MAX/2)
01222 return AVERROR(EINVAL);
01223
01224
01225
01226
01227 q->decoded_bytes_buffer =
01228 av_mallocz(avctx->block_align
01229 + DECODE_BYTES_PAD1(avctx->block_align)
01230 + FF_INPUT_BUFFER_PADDING_SIZE);
01231 if (q->decoded_bytes_buffer == NULL)
01232 return AVERROR(ENOMEM);
01233
01234
01235 if ((ret = init_cook_mlt(q)))
01236 return ret;
01237
01238
01239 if (1) {
01240 q->scalar_dequant = scalar_dequant_float;
01241 q->decouple = decouple_float;
01242 q->imlt_window = imlt_window_float;
01243 q->interpolate = interpolate_float;
01244 q->saturate_output = saturate_output_float;
01245 }
01246
01247
01248 if ((q->samples_per_channel == 256) || (q->samples_per_channel == 512) || (q->samples_per_channel == 1024)) {
01249 } else {
01250 av_log_ask_for_sample(avctx,
01251 "unknown amount of samples_per_channel = %d\n",
01252 q->samples_per_channel);
01253 return AVERROR_PATCHWELCOME;
01254 }
01255
01256 avctx->sample_fmt = AV_SAMPLE_FMT_FLT;
01257 if (channel_mask)
01258 avctx->channel_layout = channel_mask;
01259 else
01260 avctx->channel_layout = (avctx->channels==2) ? AV_CH_LAYOUT_STEREO : AV_CH_LAYOUT_MONO;
01261
01262 avcodec_get_frame_defaults(&q->frame);
01263 avctx->coded_frame = &q->frame;
01264
01265 #ifdef DEBUG
01266 dump_cook_context(q);
01267 #endif
01268 return 0;
01269 }
01270
01271
01272 AVCodec ff_cook_decoder =
01273 {
01274 .name = "cook",
01275 .type = AVMEDIA_TYPE_AUDIO,
01276 .id = CODEC_ID_COOK,
01277 .priv_data_size = sizeof(COOKContext),
01278 .init = cook_decode_init,
01279 .close = cook_decode_close,
01280 .decode = cook_decode_frame,
01281 .capabilities = CODEC_CAP_DR1,
01282 .long_name = NULL_IF_CONFIG_SMALL("COOK"),
01283 };