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