00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00045 #include <math.h>
00046 #include <stddef.h>
00047 #include <stdio.h>
00048
00049 #include "libavutil/lfg.h"
00050 #include "libavutil/random_seed.h"
00051 #include "avcodec.h"
00052 #include "get_bits.h"
00053 #include "dsputil.h"
00054 #include "bytestream.h"
00055 #include "fft.h"
00056
00057 #include "cookdata.h"
00058
00059
00060 #define MONO 0x1000001
00061 #define STEREO 0x1000002
00062 #define JOINT_STEREO 0x1000003
00063 #define MC_COOK 0x2000000 //multichannel Cook, not supported
00064
00065 #define SUBBAND_SIZE 20
00066 #define MAX_SUBPACKETS 5
00067
00068
00069 typedef struct {
00070 int *now;
00071 int *previous;
00072 } cook_gains;
00073
00074 typedef struct {
00075 int ch_idx;
00076 int size;
00077 int num_channels;
00078 int cookversion;
00079 int samples_per_frame;
00080 int subbands;
00081 int js_subband_start;
00082 int js_vlc_bits;
00083 int samples_per_channel;
00084 int log2_numvector_size;
00085 unsigned int channel_mask;
00086 VLC ccpl;
00087 int joint_stereo;
00088 int bits_per_subpacket;
00089 int bits_per_subpdiv;
00090 int total_subbands;
00091 int numvector_size;
00092
00093 float mono_previous_buffer1[1024];
00094 float mono_previous_buffer2[1024];
00096 cook_gains gains1;
00097 cook_gains gains2;
00098 int gain_1[9];
00099 int gain_2[9];
00100 int gain_3[9];
00101 int gain_4[9];
00102 } COOKSubpacket;
00103
00104 typedef struct cook {
00105
00106
00107
00108
00109 void (* scalar_dequant)(struct cook *q, int index, int quant_index,
00110 int* subband_coef_index, int* subband_coef_sign,
00111 float* mlt_p);
00112
00113 void (* decouple) (struct cook *q,
00114 COOKSubpacket *p,
00115 int subband,
00116 float f1, float f2,
00117 float *decode_buffer,
00118 float *mlt_buffer1, float *mlt_buffer2);
00119
00120 void (* imlt_window) (struct cook *q, float *buffer1,
00121 cook_gains *gains_ptr, float *previous_buffer);
00122
00123 void (* interpolate) (struct cook *q, float* buffer,
00124 int gain_index, int gain_index_next);
00125
00126 void (* saturate_output) (struct cook *q, int chan, int16_t *out);
00127
00128 AVCodecContext* avctx;
00129 GetBitContext gb;
00130
00131 int nb_channels;
00132 int bit_rate;
00133 int sample_rate;
00134 int num_vectors;
00135 int samples_per_channel;
00136
00137 AVLFG random_state;
00138
00139
00140 FFTContext mdct_ctx;
00141 float* mlt_window;
00142
00143
00144 VLC envelope_quant_index[13];
00145 VLC sqvh[7];
00146
00147
00148 int gain_size_factor;
00149 float gain_table[23];
00150
00151
00152
00153 uint8_t* decoded_bytes_buffer;
00154 DECLARE_ALIGNED(16, float,mono_mdct_output)[2048];
00155 float decode_buffer_1[1024];
00156 float decode_buffer_2[1024];
00157 float decode_buffer_0[1060];
00158
00159 const float *cplscales[5];
00160 int num_subpackets;
00161 COOKSubpacket subpacket[MAX_SUBPACKETS];
00162 } COOKContext;
00163
00164 static float pow2tab[127];
00165 static float rootpow2tab[127];
00166
00167
00168
00169 #ifdef COOKDEBUG
00170 static void dump_float_table(float* table, int size, int delimiter) {
00171 int i=0;
00172 av_log(NULL,AV_LOG_ERROR,"\n[%d]: ",i);
00173 for (i=0 ; i<size ; i++) {
00174 av_log(NULL, AV_LOG_ERROR, "%5.1f, ", table[i]);
00175 if ((i+1)%delimiter == 0) av_log(NULL,AV_LOG_ERROR,"\n[%d]: ",i+1);
00176 }
00177 }
00178
00179 static void dump_int_table(int* table, int size, int delimiter) {
00180 int i=0;
00181 av_log(NULL,AV_LOG_ERROR,"\n[%d]: ",i);
00182 for (i=0 ; i<size ; i++) {
00183 av_log(NULL, AV_LOG_ERROR, "%d, ", table[i]);
00184 if ((i+1)%delimiter == 0) av_log(NULL,AV_LOG_ERROR,"\n[%d]: ",i+1);
00185 }
00186 }
00187
00188 static void dump_short_table(short* table, int size, int delimiter) {
00189 int i=0;
00190 av_log(NULL,AV_LOG_ERROR,"\n[%d]: ",i);
00191 for (i=0 ; i<size ; i++) {
00192 av_log(NULL, AV_LOG_ERROR, "%d, ", table[i]);
00193 if ((i+1)%delimiter == 0) av_log(NULL,AV_LOG_ERROR,"\n[%d]: ",i+1);
00194 }
00195 }
00196
00197 #endif
00198
00199
00200
00201
00202 static av_cold void init_pow2table(void){
00203 int i;
00204 for (i=-63 ; i<64 ; i++){
00205 pow2tab[63+i]= pow(2, i);
00206 rootpow2tab[63+i]=sqrt(pow(2, i));
00207 }
00208 }
00209
00210
00211 static av_cold void init_gain_table(COOKContext *q) {
00212 int i;
00213 q->gain_size_factor = q->samples_per_channel/8;
00214 for (i=0 ; i<23 ; i++) {
00215 q->gain_table[i] = pow(pow2tab[i+52] ,
00216 (1.0/(double)q->gain_size_factor));
00217 }
00218 }
00219
00220
00221 static av_cold int init_cook_vlc_tables(COOKContext *q) {
00222 int i, result;
00223
00224 result = 0;
00225 for (i=0 ; i<13 ; i++) {
00226 result |= init_vlc (&q->envelope_quant_index[i], 9, 24,
00227 envelope_quant_index_huffbits[i], 1, 1,
00228 envelope_quant_index_huffcodes[i], 2, 2, 0);
00229 }
00230 av_log(q->avctx,AV_LOG_DEBUG,"sqvh VLC init\n");
00231 for (i=0 ; i<7 ; i++) {
00232 result |= init_vlc (&q->sqvh[i], vhvlcsize_tab[i], vhsize_tab[i],
00233 cvh_huffbits[i], 1, 1,
00234 cvh_huffcodes[i], 2, 2, 0);
00235 }
00236
00237 for(i=0;i<q->num_subpackets;i++){
00238 if (q->subpacket[i].joint_stereo==1){
00239 result |= init_vlc (&q->subpacket[i].ccpl, 6, (1<<q->subpacket[i].js_vlc_bits)-1,
00240 ccpl_huffbits[q->subpacket[i].js_vlc_bits-2], 1, 1,
00241 ccpl_huffcodes[q->subpacket[i].js_vlc_bits-2], 2, 2, 0);
00242 av_log(q->avctx,AV_LOG_DEBUG,"subpacket %i Joint-stereo VLC used.\n",i);
00243 }
00244 }
00245
00246 av_log(q->avctx,AV_LOG_DEBUG,"VLC tables initialized.\n");
00247 return result;
00248 }
00249
00250 static av_cold int init_cook_mlt(COOKContext *q) {
00251 int j;
00252 int mlt_size = q->samples_per_channel;
00253
00254 if ((q->mlt_window = av_malloc(sizeof(float)*mlt_size)) == 0)
00255 return -1;
00256
00257
00258 ff_sine_window_init(q->mlt_window, mlt_size);
00259 for(j=0 ; j<mlt_size ; j++)
00260 q->mlt_window[j] *= sqrt(2.0 / q->samples_per_channel);
00261
00262
00263 if (ff_mdct_init(&q->mdct_ctx, av_log2(mlt_size)+1, 1, 1.0)) {
00264 av_free(q->mlt_window);
00265 return -1;
00266 }
00267 av_log(q->avctx,AV_LOG_DEBUG,"MDCT initialized, order = %d.\n",
00268 av_log2(mlt_size)+1);
00269
00270 return 0;
00271 }
00272
00273 static const float *maybe_reformat_buffer32 (COOKContext *q, const float *ptr, int n)
00274 {
00275 if (1)
00276 return ptr;
00277 }
00278
00279 static av_cold void init_cplscales_table (COOKContext *q) {
00280 int i;
00281 for (i=0;i<5;i++)
00282 q->cplscales[i] = maybe_reformat_buffer32 (q, cplscales[i], (1<<(i+2))-1);
00283 }
00284
00285
00286
00287 #define DECODE_BYTES_PAD1(bytes) (3 - ((bytes)+3) % 4)
00288 #define DECODE_BYTES_PAD2(bytes) ((bytes) % 4 + DECODE_BYTES_PAD1(2 * (bytes)))
00289
00311 static inline int decode_bytes(const uint8_t* inbuffer, uint8_t* out, int bytes){
00312 int i, off;
00313 uint32_t c;
00314 const uint32_t* buf;
00315 uint32_t* obuf = (uint32_t*) out;
00316
00317
00318
00319
00320
00321
00322 off = (intptr_t)inbuffer & 3;
00323 buf = (const uint32_t*) (inbuffer - off);
00324 c = av_be2ne32((0x37c511f2 >> (off*8)) | (0x37c511f2 << (32-(off*8))));
00325 bytes += 3 + off;
00326 for (i = 0; i < bytes/4; i++)
00327 obuf[i] = c ^ buf[i];
00328
00329 return off;
00330 }
00331
00336 static av_cold int cook_decode_close(AVCodecContext *avctx)
00337 {
00338 int i;
00339 COOKContext *q = avctx->priv_data;
00340 av_log(avctx,AV_LOG_DEBUG, "Deallocating memory.\n");
00341
00342
00343 av_free(q->mlt_window);
00344 av_free(q->decoded_bytes_buffer);
00345
00346
00347 ff_mdct_end(&q->mdct_ctx);
00348
00349
00350 for (i=0 ; i<13 ; i++) {
00351 free_vlc(&q->envelope_quant_index[i]);
00352 }
00353 for (i=0 ; i<7 ; i++) {
00354 free_vlc(&q->sqvh[i]);
00355 }
00356 for (i=0 ; i<q->num_subpackets ; i++) {
00357 free_vlc(&q->subpacket[i].ccpl);
00358 }
00359
00360 av_log(avctx,AV_LOG_DEBUG,"Memory deallocated.\n");
00361
00362 return 0;
00363 }
00364
00372 static void decode_gain_info(GetBitContext *gb, int *gaininfo)
00373 {
00374 int i, n;
00375
00376 while (get_bits1(gb)) {}
00377 n = get_bits_count(gb) - 1;
00378
00379 i = 0;
00380 while (n--) {
00381 int index = get_bits(gb, 3);
00382 int gain = get_bits1(gb) ? get_bits(gb, 4) - 7 : -1;
00383
00384 while (i <= index) gaininfo[i++] = gain;
00385 }
00386 while (i <= 8) gaininfo[i++] = 0;
00387 }
00388
00396 static void decode_envelope(COOKContext *q, COOKSubpacket *p, int* quant_index_table) {
00397 int i,j, vlc_index;
00398
00399 quant_index_table[0]= get_bits(&q->gb,6) - 6;
00400
00401 for (i=1 ; i < p->total_subbands ; i++){
00402 vlc_index=i;
00403 if (i >= p->js_subband_start * 2) {
00404 vlc_index-=p->js_subband_start;
00405 } else {
00406 vlc_index/=2;
00407 if(vlc_index < 1) vlc_index = 1;
00408 }
00409 if (vlc_index>13) vlc_index = 13;
00410
00411 j = get_vlc2(&q->gb, q->envelope_quant_index[vlc_index-1].table,
00412 q->envelope_quant_index[vlc_index-1].bits,2);
00413 quant_index_table[i] = quant_index_table[i-1] + j - 12;
00414 }
00415 }
00416
00426 static void categorize(COOKContext *q, COOKSubpacket *p, int* quant_index_table,
00427 int* category, int* category_index){
00428 int exp_idx, bias, tmpbias1, tmpbias2, bits_left, num_bits, index, v, i, j;
00429 int exp_index2[102];
00430 int exp_index1[102];
00431
00432 int tmp_categorize_array[128*2];
00433 int tmp_categorize_array1_idx=p->numvector_size;
00434 int tmp_categorize_array2_idx=p->numvector_size;
00435
00436 bits_left = p->bits_per_subpacket - get_bits_count(&q->gb);
00437
00438 if(bits_left > q->samples_per_channel) {
00439 bits_left = q->samples_per_channel +
00440 ((bits_left - q->samples_per_channel)*5)/8;
00441
00442 }
00443
00444 memset(&exp_index1,0,102*sizeof(int));
00445 memset(&exp_index2,0,102*sizeof(int));
00446 memset(&tmp_categorize_array,0,128*2*sizeof(int));
00447
00448 bias=-32;
00449
00450
00451 for (i=32 ; i>0 ; i=i/2){
00452 num_bits = 0;
00453 index = 0;
00454 for (j=p->total_subbands ; j>0 ; j--){
00455 exp_idx = av_clip((i - quant_index_table[index] + bias) / 2, 0, 7);
00456 index++;
00457 num_bits+=expbits_tab[exp_idx];
00458 }
00459 if(num_bits >= bits_left - 32){
00460 bias+=i;
00461 }
00462 }
00463
00464
00465 num_bits=0;
00466 for (i=0 ; i<p->total_subbands ; i++) {
00467 exp_idx = av_clip((bias - quant_index_table[i]) / 2, 0, 7);
00468 num_bits += expbits_tab[exp_idx];
00469 exp_index1[i] = exp_idx;
00470 exp_index2[i] = exp_idx;
00471 }
00472 tmpbias1 = tmpbias2 = num_bits;
00473
00474 for (j = 1 ; j < p->numvector_size ; j++) {
00475 if (tmpbias1 + tmpbias2 > 2*bits_left) {
00476 int max = -999999;
00477 index=-1;
00478 for (i=0 ; i<p->total_subbands ; i++){
00479 if (exp_index1[i] < 7) {
00480 v = (-2*exp_index1[i]) - quant_index_table[i] + bias;
00481 if ( v >= max) {
00482 max = v;
00483 index = i;
00484 }
00485 }
00486 }
00487 if(index==-1)break;
00488 tmp_categorize_array[tmp_categorize_array1_idx++] = index;
00489 tmpbias1 -= expbits_tab[exp_index1[index]] -
00490 expbits_tab[exp_index1[index]+1];
00491 ++exp_index1[index];
00492 } else {
00493 int min = 999999;
00494 index=-1;
00495 for (i=0 ; i<p->total_subbands ; i++){
00496 if(exp_index2[i] > 0){
00497 v = (-2*exp_index2[i])-quant_index_table[i]+bias;
00498 if ( v < min) {
00499 min = v;
00500 index = i;
00501 }
00502 }
00503 }
00504 if(index == -1)break;
00505 tmp_categorize_array[--tmp_categorize_array2_idx] = index;
00506 tmpbias2 -= expbits_tab[exp_index2[index]] -
00507 expbits_tab[exp_index2[index]-1];
00508 --exp_index2[index];
00509 }
00510 }
00511
00512 for(i=0 ; i<p->total_subbands ; i++)
00513 category[i] = exp_index2[i];
00514
00515 for(i=0 ; i<p->numvector_size-1 ; i++)
00516 category_index[i] = tmp_categorize_array[tmp_categorize_array2_idx++];
00517
00518 }
00519
00520
00529 static inline void expand_category(COOKContext *q, int* category,
00530 int* category_index){
00531 int i;
00532 for(i=0 ; i<q->num_vectors ; i++){
00533 ++category[category_index[i]];
00534 }
00535 }
00536
00548 static void scalar_dequant_float(COOKContext *q, int index, int quant_index,
00549 int* subband_coef_index, int* subband_coef_sign,
00550 float* mlt_p){
00551 int i;
00552 float f1;
00553
00554 for(i=0 ; i<SUBBAND_SIZE ; i++) {
00555 if (subband_coef_index[i]) {
00556 f1 = quant_centroid_tab[index][subband_coef_index[i]];
00557 if (subband_coef_sign[i]) f1 = -f1;
00558 } else {
00559
00560 f1 = dither_tab[index];
00561 if (av_lfg_get(&q->random_state) < 0x80000000) f1 = -f1;
00562 }
00563 mlt_p[i] = f1 * rootpow2tab[quant_index+63];
00564 }
00565 }
00575 static int unpack_SQVH(COOKContext *q, COOKSubpacket *p, int category, int* subband_coef_index,
00576 int* subband_coef_sign) {
00577 int i,j;
00578 int vlc, vd ,tmp, result;
00579
00580 vd = vd_tab[category];
00581 result = 0;
00582 for(i=0 ; i<vpr_tab[category] ; i++){
00583 vlc = get_vlc2(&q->gb, q->sqvh[category].table, q->sqvh[category].bits, 3);
00584 if (p->bits_per_subpacket < get_bits_count(&q->gb)){
00585 vlc = 0;
00586 result = 1;
00587 }
00588 for(j=vd-1 ; j>=0 ; j--){
00589 tmp = (vlc * invradix_tab[category])/0x100000;
00590 subband_coef_index[vd*i+j] = vlc - tmp * (kmax_tab[category]+1);
00591 vlc = tmp;
00592 }
00593 for(j=0 ; j<vd ; j++){
00594 if (subband_coef_index[i*vd + j]) {
00595 if(get_bits_count(&q->gb) < p->bits_per_subpacket){
00596 subband_coef_sign[i*vd+j] = get_bits1(&q->gb);
00597 } else {
00598 result=1;
00599 subband_coef_sign[i*vd+j]=0;
00600 }
00601 } else {
00602 subband_coef_sign[i*vd+j]=0;
00603 }
00604 }
00605 }
00606 return result;
00607 }
00608
00609
00620 static void decode_vectors(COOKContext* q, COOKSubpacket* p, int* category,
00621 int *quant_index_table, float* mlt_buffer){
00622
00623
00624 int subband_coef_index[SUBBAND_SIZE];
00625
00626
00627 int subband_coef_sign[SUBBAND_SIZE];
00628 int band, j;
00629 int index=0;
00630
00631 for(band=0 ; band<p->total_subbands ; band++){
00632 index = category[band];
00633 if(category[band] < 7){
00634 if(unpack_SQVH(q, p, category[band], subband_coef_index, subband_coef_sign)){
00635 index=7;
00636 for(j=0 ; j<p->total_subbands ; j++) category[band+j]=7;
00637 }
00638 }
00639 if(index>=7) {
00640 memset(subband_coef_index, 0, sizeof(subband_coef_index));
00641 memset(subband_coef_sign, 0, sizeof(subband_coef_sign));
00642 }
00643 q->scalar_dequant(q, index, quant_index_table[band],
00644 subband_coef_index, subband_coef_sign,
00645 &mlt_buffer[band * SUBBAND_SIZE]);
00646 }
00647
00648 if(p->total_subbands*SUBBAND_SIZE >= q->samples_per_channel){
00649 return;
00650 }
00651 }
00652
00653
00661 static void mono_decode(COOKContext *q, COOKSubpacket *p, float* mlt_buffer) {
00662
00663 int category_index[128];
00664 int quant_index_table[102];
00665 int category[128];
00666
00667 memset(&category, 0, 128*sizeof(int));
00668 memset(&category_index, 0, 128*sizeof(int));
00669
00670 decode_envelope(q, p, quant_index_table);
00671 q->num_vectors = get_bits(&q->gb,p->log2_numvector_size);
00672 categorize(q, p, quant_index_table, category, category_index);
00673 expand_category(q, category, category_index);
00674 decode_vectors(q, p, category, quant_index_table, mlt_buffer);
00675 }
00676
00677
00687 static void interpolate_float(COOKContext *q, float* buffer,
00688 int gain_index, int gain_index_next){
00689 int i;
00690 float fc1, fc2;
00691 fc1 = pow2tab[gain_index+63];
00692
00693 if(gain_index == gain_index_next){
00694 for(i=0 ; i<q->gain_size_factor ; i++){
00695 buffer[i]*=fc1;
00696 }
00697 return;
00698 } else {
00699 fc2 = q->gain_table[11 + (gain_index_next-gain_index)];
00700 for(i=0 ; i<q->gain_size_factor ; i++){
00701 buffer[i]*=fc1;
00702 fc1*=fc2;
00703 }
00704 return;
00705 }
00706 }
00707
00717 static void imlt_window_float (COOKContext *q, float *inbuffer,
00718 cook_gains *gains_ptr, float *previous_buffer)
00719 {
00720 const float fc = pow2tab[gains_ptr->previous[0] + 63];
00721 int i;
00722
00723
00724
00725
00726
00727
00728
00729 for(i = 0; i < q->samples_per_channel; i++){
00730 inbuffer[i] = inbuffer[i] * fc * q->mlt_window[i] -
00731 previous_buffer[i] * q->mlt_window[q->samples_per_channel - 1 - i];
00732 }
00733 }
00734
00747 static void imlt_gain(COOKContext *q, float *inbuffer,
00748 cook_gains *gains_ptr, float* previous_buffer)
00749 {
00750 float *buffer0 = q->mono_mdct_output;
00751 float *buffer1 = q->mono_mdct_output + q->samples_per_channel;
00752 int i;
00753
00754
00755 ff_imdct_calc(&q->mdct_ctx, q->mono_mdct_output, inbuffer);
00756
00757 q->imlt_window (q, buffer1, gains_ptr, previous_buffer);
00758
00759
00760 for (i = 0; i < 8; i++) {
00761 if (gains_ptr->now[i] || gains_ptr->now[i + 1])
00762 q->interpolate(q, &buffer1[q->gain_size_factor * i],
00763 gains_ptr->now[i], gains_ptr->now[i + 1]);
00764 }
00765
00766
00767 memcpy(previous_buffer, buffer0, sizeof(float)*q->samples_per_channel);
00768 }
00769
00770
00779 static void decouple_info(COOKContext *q, COOKSubpacket *p, int* decouple_tab){
00780 int length, i;
00781
00782 if(get_bits1(&q->gb)) {
00783 if(cplband[p->js_subband_start] > cplband[p->subbands-1]) return;
00784
00785 length = cplband[p->subbands-1] - cplband[p->js_subband_start] + 1;
00786 for (i=0 ; i<length ; i++) {
00787 decouple_tab[cplband[p->js_subband_start] + i] = get_vlc2(&q->gb, p->ccpl.table, p->ccpl.bits, 2);
00788 }
00789 return;
00790 }
00791
00792 if(cplband[p->js_subband_start] > cplband[p->subbands-1]) return;
00793
00794 length = cplband[p->subbands-1] - cplband[p->js_subband_start] + 1;
00795 for (i=0 ; i<length ; i++) {
00796 decouple_tab[cplband[p->js_subband_start] + i] = get_bits(&q->gb, p->js_vlc_bits);
00797 }
00798 return;
00799 }
00800
00801
00802
00803
00804
00805
00806
00807
00808
00809
00810
00811
00812 static void decouple_float (COOKContext *q,
00813 COOKSubpacket *p,
00814 int subband,
00815 float f1, float f2,
00816 float *decode_buffer,
00817 float *mlt_buffer1, float *mlt_buffer2)
00818 {
00819 int j, tmp_idx;
00820 for (j=0 ; j<SUBBAND_SIZE ; j++) {
00821 tmp_idx = ((p->js_subband_start + subband)*SUBBAND_SIZE)+j;
00822 mlt_buffer1[SUBBAND_SIZE*subband + j] = f1 * decode_buffer[tmp_idx];
00823 mlt_buffer2[SUBBAND_SIZE*subband + j] = f2 * decode_buffer[tmp_idx];
00824 }
00825 }
00826
00835 static void joint_decode(COOKContext *q, COOKSubpacket *p, float* mlt_buffer1,
00836 float* mlt_buffer2) {
00837 int i,j;
00838 int decouple_tab[SUBBAND_SIZE];
00839 float *decode_buffer = q->decode_buffer_0;
00840 int idx, cpl_tmp;
00841 float f1,f2;
00842 const float* cplscale;
00843
00844 memset(decouple_tab, 0, sizeof(decouple_tab));
00845 memset(decode_buffer, 0, sizeof(decode_buffer));
00846
00847
00848 memset(mlt_buffer1,0, 1024*sizeof(float));
00849 memset(mlt_buffer2,0, 1024*sizeof(float));
00850 decouple_info(q, p, decouple_tab);
00851 mono_decode(q, p, decode_buffer);
00852
00853
00854 for (i=0 ; i<p->js_subband_start ; i++) {
00855 for (j=0 ; j<SUBBAND_SIZE ; j++) {
00856 mlt_buffer1[i*20+j] = decode_buffer[i*40+j];
00857 mlt_buffer2[i*20+j] = decode_buffer[i*40+20+j];
00858 }
00859 }
00860
00861
00862
00863 idx = (1 << p->js_vlc_bits) - 1;
00864 for (i=p->js_subband_start ; i<p->subbands ; i++) {
00865 cpl_tmp = cplband[i];
00866 idx -=decouple_tab[cpl_tmp];
00867 cplscale = q->cplscales[p->js_vlc_bits-2];
00868 f1 = cplscale[decouple_tab[cpl_tmp]];
00869 f2 = cplscale[idx-1];
00870 q->decouple (q, p, i, f1, f2, decode_buffer, mlt_buffer1, mlt_buffer2);
00871 idx = (1 << p->js_vlc_bits) - 1;
00872 }
00873 }
00874
00884 static inline void
00885 decode_bytes_and_gain(COOKContext *q, COOKSubpacket *p, const uint8_t *inbuffer,
00886 cook_gains *gains_ptr)
00887 {
00888 int offset;
00889
00890 offset = decode_bytes(inbuffer, q->decoded_bytes_buffer,
00891 p->bits_per_subpacket/8);
00892 init_get_bits(&q->gb, q->decoded_bytes_buffer + offset,
00893 p->bits_per_subpacket);
00894 decode_gain_info(&q->gb, gains_ptr->now);
00895
00896
00897 FFSWAP(int *, gains_ptr->now, gains_ptr->previous);
00898 }
00899
00907 static void
00908 saturate_output_float (COOKContext *q, int chan, int16_t *out)
00909 {
00910 int j;
00911 float *output = q->mono_mdct_output + q->samples_per_channel;
00912
00913
00914 for (j = 0; j < q->samples_per_channel; j++) {
00915 out[chan + q->nb_channels * j] =
00916 av_clip_int16(lrintf(output[j]));
00917 }
00918 }
00919
00933 static inline void
00934 mlt_compensate_output(COOKContext *q, float *decode_buffer,
00935 cook_gains *gains_ptr, float *previous_buffer,
00936 int16_t *out, int chan)
00937 {
00938 imlt_gain(q, decode_buffer, gains_ptr, previous_buffer);
00939 q->saturate_output (q, chan, out);
00940 }
00941
00942
00951 static void decode_subpacket(COOKContext *q, COOKSubpacket* p, const uint8_t *inbuffer, int16_t *outbuffer) {
00952 int sub_packet_size = p->size;
00953
00954
00955
00956
00957
00958 memset(q->decode_buffer_1,0,sizeof(q->decode_buffer_1));
00959 decode_bytes_and_gain(q, p, inbuffer, &p->gains1);
00960
00961 if (p->joint_stereo) {
00962 joint_decode(q, p, q->decode_buffer_1, q->decode_buffer_2);
00963 } else {
00964 mono_decode(q, p, q->decode_buffer_1);
00965
00966 if (p->num_channels == 2) {
00967 decode_bytes_and_gain(q, p, inbuffer + sub_packet_size/2, &p->gains2);
00968 mono_decode(q, p, q->decode_buffer_2);
00969 }
00970 }
00971
00972 mlt_compensate_output(q, q->decode_buffer_1, &p->gains1,
00973 p->mono_previous_buffer1, outbuffer, p->ch_idx);
00974
00975 if (p->num_channels == 2) {
00976 if (p->joint_stereo) {
00977 mlt_compensate_output(q, q->decode_buffer_2, &p->gains1,
00978 p->mono_previous_buffer2, outbuffer, p->ch_idx + 1);
00979 } else {
00980 mlt_compensate_output(q, q->decode_buffer_2, &p->gains2,
00981 p->mono_previous_buffer2, outbuffer, p->ch_idx + 1);
00982 }
00983 }
00984
00985 }
00986
00987
00994 static int cook_decode_frame(AVCodecContext *avctx,
00995 void *data, int *data_size,
00996 AVPacket *avpkt) {
00997 const uint8_t *buf = avpkt->data;
00998 int buf_size = avpkt->size;
00999 COOKContext *q = avctx->priv_data;
01000 int i;
01001 int offset = 0;
01002 int chidx = 0;
01003
01004 if (buf_size < avctx->block_align)
01005 return buf_size;
01006
01007
01008 q->subpacket[0].size = avctx->block_align;
01009
01010 for(i=1;i<q->num_subpackets;i++){
01011 q->subpacket[i].size = 2 * buf[avctx->block_align - q->num_subpackets + i];
01012 q->subpacket[0].size -= q->subpacket[i].size + 1;
01013 if (q->subpacket[0].size < 0) {
01014 av_log(avctx,AV_LOG_DEBUG,"frame subpacket size total > avctx->block_align!\n");
01015 return -1;
01016 }
01017 }
01018
01019
01020 *data_size = 0;
01021 for(i=0;i<q->num_subpackets;i++){
01022 q->subpacket[i].bits_per_subpacket = (q->subpacket[i].size*8)>>q->subpacket[i].bits_per_subpdiv;
01023 q->subpacket[i].ch_idx = chidx;
01024 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);
01025 decode_subpacket(q, &q->subpacket[i], buf + offset, (int16_t*)data);
01026 offset += q->subpacket[i].size;
01027 chidx += q->subpacket[i].num_channels;
01028 av_log(avctx,AV_LOG_DEBUG,"subpacket[%i] %i %i\n",i,q->subpacket[i].size * 8,get_bits_count(&q->gb));
01029 }
01030 *data_size = sizeof(int16_t) * q->nb_channels * q->samples_per_channel;
01031
01032
01033 if (avctx->frame_number < 2) *data_size = 0;
01034
01035 return avctx->block_align;
01036 }
01037
01038 #ifdef COOKDEBUG
01039 static void dump_cook_context(COOKContext *q)
01040 {
01041
01042 #define PRINT(a,b) av_log(q->avctx,AV_LOG_ERROR," %s = %d\n", a, b);
01043 av_log(q->avctx,AV_LOG_ERROR,"COOKextradata\n");
01044 av_log(q->avctx,AV_LOG_ERROR,"cookversion=%x\n",q->subpacket[0].cookversion);
01045 if (q->subpacket[0].cookversion > STEREO) {
01046 PRINT("js_subband_start",q->subpacket[0].js_subband_start);
01047 PRINT("js_vlc_bits",q->subpacket[0].js_vlc_bits);
01048 }
01049 av_log(q->avctx,AV_LOG_ERROR,"COOKContext\n");
01050 PRINT("nb_channels",q->nb_channels);
01051 PRINT("bit_rate",q->bit_rate);
01052 PRINT("sample_rate",q->sample_rate);
01053 PRINT("samples_per_channel",q->subpacket[0].samples_per_channel);
01054 PRINT("samples_per_frame",q->subpacket[0].samples_per_frame);
01055 PRINT("subbands",q->subpacket[0].subbands);
01056 PRINT("random_state",q->random_state);
01057 PRINT("js_subband_start",q->subpacket[0].js_subband_start);
01058 PRINT("log2_numvector_size",q->subpacket[0].log2_numvector_size);
01059 PRINT("numvector_size",q->subpacket[0].numvector_size);
01060 PRINT("total_subbands",q->subpacket[0].total_subbands);
01061 }
01062 #endif
01063
01064 static av_cold int cook_count_channels(unsigned int mask){
01065 int i;
01066 int channels = 0;
01067 for(i = 0;i<32;i++){
01068 if(mask & (1<<i))
01069 ++channels;
01070 }
01071 return channels;
01072 }
01073
01080 static av_cold int cook_decode_init(AVCodecContext *avctx)
01081 {
01082 COOKContext *q = avctx->priv_data;
01083 const uint8_t *edata_ptr = avctx->extradata;
01084 const uint8_t *edata_ptr_end = edata_ptr + avctx->extradata_size;
01085 int extradata_size = avctx->extradata_size;
01086 int s = 0;
01087 unsigned int channel_mask = 0;
01088 q->avctx = avctx;
01089
01090
01091 if (extradata_size <= 0) {
01092 av_log(avctx,AV_LOG_ERROR,"Necessary extradata missing!\n");
01093 return -1;
01094 }
01095 av_log(avctx,AV_LOG_DEBUG,"codecdata_length=%d\n",avctx->extradata_size);
01096
01097
01098 q->sample_rate = avctx->sample_rate;
01099 q->nb_channels = avctx->channels;
01100 q->bit_rate = avctx->bit_rate;
01101
01102
01103 av_lfg_init(&q->random_state, 0);
01104
01105 while(edata_ptr < edata_ptr_end){
01106
01107
01108 if (extradata_size >= 8){
01109 q->subpacket[s].cookversion = bytestream_get_be32(&edata_ptr);
01110 q->subpacket[s].samples_per_frame = bytestream_get_be16(&edata_ptr);
01111 q->subpacket[s].subbands = bytestream_get_be16(&edata_ptr);
01112 extradata_size -= 8;
01113 }
01114 if (avctx->extradata_size >= 8){
01115 bytestream_get_be32(&edata_ptr);
01116 q->subpacket[s].js_subband_start = bytestream_get_be16(&edata_ptr);
01117 q->subpacket[s].js_vlc_bits = bytestream_get_be16(&edata_ptr);
01118 extradata_size -= 8;
01119 }
01120
01121
01122 q->subpacket[s].samples_per_channel = q->subpacket[s].samples_per_frame / q->nb_channels;
01123 q->subpacket[s].bits_per_subpacket = avctx->block_align * 8;
01124
01125
01126 q->subpacket[s].log2_numvector_size = 5;
01127 q->subpacket[s].total_subbands = q->subpacket[s].subbands;
01128 q->subpacket[s].num_channels = 1;
01129
01130
01131
01132 av_log(avctx,AV_LOG_DEBUG,"subpacket[%i].cookversion=%x\n",s,q->subpacket[s].cookversion);
01133 q->subpacket[s].joint_stereo = 0;
01134 switch (q->subpacket[s].cookversion) {
01135 case MONO:
01136 if (q->nb_channels != 1) {
01137 av_log(avctx,AV_LOG_ERROR,"Container channels != 1, report sample!\n");
01138 return -1;
01139 }
01140 av_log(avctx,AV_LOG_DEBUG,"MONO\n");
01141 break;
01142 case STEREO:
01143 if (q->nb_channels != 1) {
01144 q->subpacket[s].bits_per_subpdiv = 1;
01145 q->subpacket[s].num_channels = 2;
01146 }
01147 av_log(avctx,AV_LOG_DEBUG,"STEREO\n");
01148 break;
01149 case JOINT_STEREO:
01150 if (q->nb_channels != 2) {
01151 av_log(avctx,AV_LOG_ERROR,"Container channels != 2, report sample!\n");
01152 return -1;
01153 }
01154 av_log(avctx,AV_LOG_DEBUG,"JOINT_STEREO\n");
01155 if (avctx->extradata_size >= 16){
01156 q->subpacket[s].total_subbands = q->subpacket[s].subbands + q->subpacket[s].js_subband_start;
01157 q->subpacket[s].joint_stereo = 1;
01158 q->subpacket[s].num_channels = 2;
01159 }
01160 if (q->subpacket[s].samples_per_channel > 256) {
01161 q->subpacket[s].log2_numvector_size = 6;
01162 }
01163 if (q->subpacket[s].samples_per_channel > 512) {
01164 q->subpacket[s].log2_numvector_size = 7;
01165 }
01166 break;
01167 case MC_COOK:
01168 av_log(avctx,AV_LOG_DEBUG,"MULTI_CHANNEL\n");
01169 if(extradata_size >= 4)
01170 channel_mask |= q->subpacket[s].channel_mask = bytestream_get_be32(&edata_ptr);
01171
01172 if(cook_count_channels(q->subpacket[s].channel_mask) > 1){
01173 q->subpacket[s].total_subbands = q->subpacket[s].subbands + q->subpacket[s].js_subband_start;
01174 q->subpacket[s].joint_stereo = 1;
01175 q->subpacket[s].num_channels = 2;
01176 q->subpacket[s].samples_per_channel = q->subpacket[s].samples_per_frame >> 1;
01177
01178 if (q->subpacket[s].samples_per_channel > 256) {
01179 q->subpacket[s].log2_numvector_size = 6;
01180 }
01181 if (q->subpacket[s].samples_per_channel > 512) {
01182 q->subpacket[s].log2_numvector_size = 7;
01183 }
01184 }else
01185 q->subpacket[s].samples_per_channel = q->subpacket[s].samples_per_frame;
01186
01187 break;
01188 default:
01189 av_log(avctx,AV_LOG_ERROR,"Unknown Cook version, report sample!\n");
01190 return -1;
01191 break;
01192 }
01193
01194 if(s > 1 && q->subpacket[s].samples_per_channel != q->samples_per_channel) {
01195 av_log(avctx,AV_LOG_ERROR,"different number of samples per channel!\n");
01196 return -1;
01197 } else
01198 q->samples_per_channel = q->subpacket[0].samples_per_channel;
01199
01200
01201
01202 q->subpacket[s].numvector_size = (1 << q->subpacket[s].log2_numvector_size);
01203
01204
01205 if (q->subpacket[s].total_subbands > 53) {
01206 av_log(avctx,AV_LOG_ERROR,"total_subbands > 53, report sample!\n");
01207 return -1;
01208 }
01209
01210 if ((q->subpacket[s].js_vlc_bits > 6) || (q->subpacket[s].js_vlc_bits < 0)) {
01211 av_log(avctx,AV_LOG_ERROR,"js_vlc_bits = %d, only >= 0 and <= 6 allowed!\n",q->subpacket[s].js_vlc_bits);
01212 return -1;
01213 }
01214
01215 if (q->subpacket[s].subbands > 50) {
01216 av_log(avctx,AV_LOG_ERROR,"subbands > 50, report sample!\n");
01217 return -1;
01218 }
01219 q->subpacket[s].gains1.now = q->subpacket[s].gain_1;
01220 q->subpacket[s].gains1.previous = q->subpacket[s].gain_2;
01221 q->subpacket[s].gains2.now = q->subpacket[s].gain_3;
01222 q->subpacket[s].gains2.previous = q->subpacket[s].gain_4;
01223
01224 q->num_subpackets++;
01225 s++;
01226 if (s > MAX_SUBPACKETS) {
01227 av_log(avctx,AV_LOG_ERROR,"Too many subpackets > 5, report file!\n");
01228 return -1;
01229 }
01230 }
01231
01232 init_pow2table();
01233 init_gain_table(q);
01234 init_cplscales_table(q);
01235
01236 if (init_cook_vlc_tables(q) != 0)
01237 return -1;
01238
01239
01240 if(avctx->block_align >= UINT_MAX/2)
01241 return -1;
01242
01243
01244
01245
01246 q->decoded_bytes_buffer =
01247 av_mallocz(avctx->block_align
01248 + DECODE_BYTES_PAD1(avctx->block_align)
01249 + FF_INPUT_BUFFER_PADDING_SIZE);
01250 if (q->decoded_bytes_buffer == NULL)
01251 return -1;
01252
01253
01254 if ( init_cook_mlt(q) != 0 )
01255 return -1;
01256
01257
01258 if (1) {
01259 q->scalar_dequant = scalar_dequant_float;
01260 q->decouple = decouple_float;
01261 q->imlt_window = imlt_window_float;
01262 q->interpolate = interpolate_float;
01263 q->saturate_output = saturate_output_float;
01264 }
01265
01266
01267 if ((q->samples_per_channel == 256) || (q->samples_per_channel == 512) || (q->samples_per_channel == 1024)) {
01268 } else {
01269 av_log(avctx,AV_LOG_ERROR,"unknown amount of samples_per_channel = %d, report sample!\n",q->samples_per_channel);
01270 return -1;
01271 }
01272
01273 avctx->sample_fmt = AV_SAMPLE_FMT_S16;
01274 if (channel_mask)
01275 avctx->channel_layout = channel_mask;
01276 else
01277 avctx->channel_layout = (avctx->channels==2) ? CH_LAYOUT_STEREO : CH_LAYOUT_MONO;
01278
01279 #ifdef COOKDEBUG
01280 dump_cook_context(q);
01281 #endif
01282 return 0;
01283 }
01284
01285
01286 AVCodec cook_decoder =
01287 {
01288 .name = "cook",
01289 .type = AVMEDIA_TYPE_AUDIO,
01290 .id = CODEC_ID_COOK,
01291 .priv_data_size = sizeof(COOKContext),
01292 .init = cook_decode_init,
01293 .close = cook_decode_close,
01294 .decode = cook_decode_frame,
01295 .long_name = NULL_IF_CONFIG_SMALL("COOK"),
01296 };