michael@0: /******************************************************************** michael@0: * * michael@0: * THIS FILE IS PART OF THE OggVorbis 'TREMOR' CODEC SOURCE CODE. * michael@0: * * michael@0: * USE, DISTRIBUTION AND REPRODUCTION OF THIS LIBRARY SOURCE IS * michael@0: * GOVERNED BY A BSD-STYLE SOURCE LICENSE INCLUDED WITH THIS SOURCE * michael@0: * IN 'COPYING'. PLEASE READ THESE TERMS BEFORE DISTRIBUTING. * michael@0: * * michael@0: * THE OggVorbis 'TREMOR' SOURCE CODE IS (C) COPYRIGHT 1994-2002 * michael@0: * BY THE Xiph.Org FOUNDATION http://www.xiph.org/ * michael@0: * * michael@0: ******************************************************************** michael@0: michael@0: function: floor backend 1 implementation michael@0: michael@0: ********************************************************************/ michael@0: michael@0: #include michael@0: #include michael@0: #include michael@0: #include michael@0: #include "ivorbiscodec.h" michael@0: #include "codec_internal.h" michael@0: #include "registry.h" michael@0: #include "codebook.h" michael@0: #include "misc.h" michael@0: #include "block.h" michael@0: michael@0: #define floor1_rangedB 140 /* floor 1 fixed at -140dB to 0dB range */ michael@0: michael@0: typedef struct { michael@0: int forward_index[VIF_POSIT+2]; michael@0: michael@0: int hineighbor[VIF_POSIT]; michael@0: int loneighbor[VIF_POSIT]; michael@0: int posts; michael@0: michael@0: int n; michael@0: int quant_q; michael@0: vorbis_info_floor1 *vi; michael@0: michael@0: } vorbis_look_floor1; michael@0: michael@0: /***********************************************/ michael@0: michael@0: static void floor1_free_info(vorbis_info_floor *i){ michael@0: vorbis_info_floor1 *info=(vorbis_info_floor1 *)i; michael@0: if(info){ michael@0: memset(info,0,sizeof(*info)); michael@0: _ogg_free(info); michael@0: } michael@0: } michael@0: michael@0: static void floor1_free_look(vorbis_look_floor *i){ michael@0: vorbis_look_floor1 *look=(vorbis_look_floor1 *)i; michael@0: if(look){ michael@0: memset(look,0,sizeof(*look)); michael@0: _ogg_free(look); michael@0: } michael@0: } michael@0: michael@0: static int ilog(unsigned int v){ michael@0: int ret=0; michael@0: while(v){ michael@0: ret++; michael@0: v>>=1; michael@0: } michael@0: return(ret); michael@0: } michael@0: michael@0: static int icomp(const void *a,const void *b){ michael@0: return(**(int **)a-**(int **)b); michael@0: } michael@0: michael@0: static vorbis_info_floor *floor1_unpack (vorbis_info *vi,oggpack_buffer *opb){ michael@0: codec_setup_info *ci=(codec_setup_info *)vi->codec_setup; michael@0: int j,k,count=0,maxclass=-1,rangebits; michael@0: michael@0: vorbis_info_floor1 *info=(vorbis_info_floor1 *)_ogg_calloc(1,sizeof(*info)); michael@0: /* read partitions */ michael@0: info->partitions=oggpack_read(opb,5); /* only 0 to 31 legal */ michael@0: for(j=0;jpartitions;j++){ michael@0: info->partitionclass[j]=oggpack_read(opb,4); /* only 0 to 15 legal */ michael@0: if(info->partitionclass[j]<0)goto err_out; michael@0: if(maxclasspartitionclass[j])maxclass=info->partitionclass[j]; michael@0: } michael@0: michael@0: /* read partition classes */ michael@0: for(j=0;jclass_dim[j]=oggpack_read(opb,3)+1; /* 1 to 8 */ michael@0: info->class_subs[j]=oggpack_read(opb,2); /* 0,1,2,3 bits */ michael@0: if(info->class_subs[j]<0) michael@0: goto err_out; michael@0: if(info->class_subs[j])info->class_book[j]=oggpack_read(opb,8); michael@0: if(info->class_book[j]<0 || info->class_book[j]>=ci->books) michael@0: goto err_out; michael@0: for(k=0;k<(1<class_subs[j]);k++){ michael@0: info->class_subbook[j][k]=oggpack_read(opb,8)-1; michael@0: if(info->class_subbook[j][k]<-1 || info->class_subbook[j][k]>=ci->books) michael@0: goto err_out; michael@0: } michael@0: } michael@0: michael@0: /* read the post list */ michael@0: info->mult=oggpack_read(opb,2)+1; /* only 1,2,3,4 legal now */ michael@0: rangebits=oggpack_read(opb,4); michael@0: if(rangebits<0)goto err_out; michael@0: michael@0: for(j=0,k=0;jpartitions;j++){ michael@0: count+=info->class_dim[info->partitionclass[j]]; michael@0: if(count>VIF_POSIT)goto err_out; michael@0: for(;kpostlist[k+2]=oggpack_read(opb,rangebits); michael@0: if(t<0 || t>=(1<postlist[0]=0; michael@0: info->postlist[1]=1<postlist+j; michael@0: qsort(sortpointer,count+2,sizeof(*sortpointer),icomp); michael@0: michael@0: for(j=1;jvi=info; michael@0: look->n=info->postlist[1]; michael@0: michael@0: /* we drop each position value in-between already decoded values, michael@0: and use linear interpolation to predict each new value past the michael@0: edges. The positions are read in the order of the position michael@0: list... we precompute the bounding positions in the lookup. Of michael@0: course, the neighbors can change (if a position is declined), but michael@0: this is an initial mapping */ michael@0: michael@0: for(i=0;ipartitions;i++)n+=info->class_dim[info->partitionclass[i]]; michael@0: n+=2; michael@0: look->posts=n; michael@0: michael@0: /* also store a sorted position index */ michael@0: for(i=0;ipostlist+i; michael@0: qsort(sortpointer,n,sizeof(*sortpointer),icomp); michael@0: michael@0: /* points from sort order back to range number */ michael@0: for(i=0;iforward_index[i]=sortpointer[i]-info->postlist; michael@0: michael@0: /* quantize values to multiplier spec */ michael@0: switch(info->mult){ michael@0: case 1: /* 1024 -> 256 */ michael@0: look->quant_q=256; michael@0: break; michael@0: case 2: /* 1024 -> 128 */ michael@0: look->quant_q=128; michael@0: break; michael@0: case 3: /* 1024 -> 86 */ michael@0: look->quant_q=86; michael@0: break; michael@0: case 4: /* 1024 -> 64 */ michael@0: look->quant_q=64; michael@0: break; michael@0: } michael@0: michael@0: /* discover our neighbors for decode where we don't use fit flags michael@0: (that would push the neighbors outward) */ michael@0: for(i=0;in; michael@0: int currentx=info->postlist[i+2]; michael@0: for(j=0;jpostlist[j]; michael@0: if(x>lx && xcurrentx){ michael@0: hi=j; michael@0: hx=x; michael@0: } michael@0: } michael@0: look->loneighbor[i]=lo; michael@0: look->hineighbor[i]=hi; michael@0: } michael@0: michael@0: return(look); michael@0: } michael@0: michael@0: static int render_point(int x0,int x1,int y0,int y1,int x){ michael@0: y0&=0x7fff; /* mask off flag */ michael@0: y1&=0x7fff; michael@0: michael@0: { michael@0: int dy=y1-y0; michael@0: int adx=x1-x0; michael@0: int ady=abs(dy); michael@0: int err=ady*(x-x0); michael@0: michael@0: int off=err/adx; michael@0: if(dy<0)return(y0-off); michael@0: return(y0+off); michael@0: } michael@0: } michael@0: michael@0: #ifdef _LOW_ACCURACY_ michael@0: # define XdB(n) ((((n)>>8)+1)>>1) michael@0: #else michael@0: # define XdB(n) (n) michael@0: #endif michael@0: michael@0: static const ogg_int32_t FLOOR_fromdB_LOOKUP[256]={ michael@0: XdB(0x000000e5), XdB(0x000000f4), XdB(0x00000103), XdB(0x00000114), michael@0: XdB(0x00000126), XdB(0x00000139), XdB(0x0000014e), XdB(0x00000163), michael@0: XdB(0x0000017a), XdB(0x00000193), XdB(0x000001ad), XdB(0x000001c9), michael@0: XdB(0x000001e7), XdB(0x00000206), XdB(0x00000228), XdB(0x0000024c), michael@0: XdB(0x00000272), XdB(0x0000029b), XdB(0x000002c6), XdB(0x000002f4), michael@0: XdB(0x00000326), XdB(0x0000035a), XdB(0x00000392), XdB(0x000003cd), michael@0: XdB(0x0000040c), XdB(0x00000450), XdB(0x00000497), XdB(0x000004e4), michael@0: XdB(0x00000535), XdB(0x0000058c), XdB(0x000005e8), XdB(0x0000064a), michael@0: XdB(0x000006b3), XdB(0x00000722), XdB(0x00000799), XdB(0x00000818), michael@0: XdB(0x0000089e), XdB(0x0000092e), XdB(0x000009c6), XdB(0x00000a69), michael@0: XdB(0x00000b16), XdB(0x00000bcf), XdB(0x00000c93), XdB(0x00000d64), michael@0: XdB(0x00000e43), XdB(0x00000f30), XdB(0x0000102d), XdB(0x0000113a), michael@0: XdB(0x00001258), XdB(0x0000138a), XdB(0x000014cf), XdB(0x00001629), michael@0: XdB(0x0000179a), XdB(0x00001922), XdB(0x00001ac4), XdB(0x00001c82), michael@0: XdB(0x00001e5c), XdB(0x00002055), XdB(0x0000226f), XdB(0x000024ac), michael@0: XdB(0x0000270e), XdB(0x00002997), XdB(0x00002c4b), XdB(0x00002f2c), michael@0: XdB(0x0000323d), XdB(0x00003581), XdB(0x000038fb), XdB(0x00003caf), michael@0: XdB(0x000040a0), XdB(0x000044d3), XdB(0x0000494c), XdB(0x00004e10), michael@0: XdB(0x00005323), XdB(0x0000588a), XdB(0x00005e4b), XdB(0x0000646b), michael@0: XdB(0x00006af2), XdB(0x000071e5), XdB(0x0000794c), XdB(0x0000812e), michael@0: XdB(0x00008993), XdB(0x00009283), XdB(0x00009c09), XdB(0x0000a62d), michael@0: XdB(0x0000b0f9), XdB(0x0000bc79), XdB(0x0000c8b9), XdB(0x0000d5c4), michael@0: XdB(0x0000e3a9), XdB(0x0000f274), XdB(0x00010235), XdB(0x000112fd), michael@0: XdB(0x000124dc), XdB(0x000137e4), XdB(0x00014c29), XdB(0x000161bf), michael@0: XdB(0x000178bc), XdB(0x00019137), XdB(0x0001ab4a), XdB(0x0001c70e), michael@0: XdB(0x0001e4a1), XdB(0x0002041f), XdB(0x000225aa), XdB(0x00024962), michael@0: XdB(0x00026f6d), XdB(0x000297f0), XdB(0x0002c316), XdB(0x0002f109), michael@0: XdB(0x000321f9), XdB(0x00035616), XdB(0x00038d97), XdB(0x0003c8b4), michael@0: XdB(0x000407a7), XdB(0x00044ab2), XdB(0x00049218), XdB(0x0004de23), michael@0: XdB(0x00052f1e), XdB(0x0005855c), XdB(0x0005e135), XdB(0x00064306), michael@0: XdB(0x0006ab33), XdB(0x00071a24), XdB(0x0007904b), XdB(0x00080e20), michael@0: XdB(0x00089422), XdB(0x000922da), XdB(0x0009bad8), XdB(0x000a5cb6), michael@0: XdB(0x000b091a), XdB(0x000bc0b1), XdB(0x000c8436), XdB(0x000d5471), michael@0: XdB(0x000e3233), XdB(0x000f1e5f), XdB(0x001019e4), XdB(0x001125c1), michael@0: XdB(0x00124306), XdB(0x001372d5), XdB(0x0014b663), XdB(0x00160ef7), michael@0: XdB(0x00177df0), XdB(0x001904c1), XdB(0x001aa4f9), XdB(0x001c603d), michael@0: XdB(0x001e384f), XdB(0x00202f0f), XdB(0x0022467a), XdB(0x002480b1), michael@0: XdB(0x0026dff7), XdB(0x002966b3), XdB(0x002c1776), XdB(0x002ef4fc), michael@0: XdB(0x0032022d), XdB(0x00354222), XdB(0x0038b828), XdB(0x003c67c2), michael@0: XdB(0x004054ae), XdB(0x004482e8), XdB(0x0048f6af), XdB(0x004db488), michael@0: XdB(0x0052c142), XdB(0x005821ff), XdB(0x005ddc33), XdB(0x0063f5b0), michael@0: XdB(0x006a74a7), XdB(0x00715faf), XdB(0x0078bdce), XdB(0x0080967f), michael@0: XdB(0x0088f1ba), XdB(0x0091d7f9), XdB(0x009b5247), XdB(0x00a56a41), michael@0: XdB(0x00b02a27), XdB(0x00bb9ce2), XdB(0x00c7ce12), XdB(0x00d4ca17), michael@0: XdB(0x00e29e20), XdB(0x00f15835), XdB(0x0101074b), XdB(0x0111bb4e), michael@0: XdB(0x01238531), XdB(0x01367704), XdB(0x014aa402), XdB(0x016020a7), michael@0: XdB(0x017702c3), XdB(0x018f6190), XdB(0x01a955cb), XdB(0x01c4f9cf), michael@0: XdB(0x01e269a8), XdB(0x0201c33b), XdB(0x0223265a), XdB(0x0246b4ea), michael@0: XdB(0x026c9302), XdB(0x0294e716), XdB(0x02bfda13), XdB(0x02ed9793), michael@0: XdB(0x031e4e09), XdB(0x03522ee4), XdB(0x03896ed0), XdB(0x03c445e2), michael@0: XdB(0x0402efd6), XdB(0x0445ac4b), XdB(0x048cbefc), XdB(0x04d87013), michael@0: XdB(0x05290c67), XdB(0x057ee5ca), XdB(0x05da5364), XdB(0x063bb204), michael@0: XdB(0x06a36485), XdB(0x0711d42b), XdB(0x0787710e), XdB(0x0804b299), michael@0: XdB(0x088a17ef), XdB(0x0918287e), XdB(0x09af747c), XdB(0x0a50957e), michael@0: XdB(0x0afc2f19), XdB(0x0bb2ef7f), XdB(0x0c759034), XdB(0x0d44d6ca), michael@0: XdB(0x0e2195bc), XdB(0x0f0cad0d), XdB(0x10070b62), XdB(0x1111aeea), michael@0: XdB(0x122da66c), XdB(0x135c120f), XdB(0x149e24d9), XdB(0x15f525b1), michael@0: XdB(0x176270e3), XdB(0x18e7794b), XdB(0x1a85c9ae), XdB(0x1c3f06d1), michael@0: XdB(0x1e14f07d), XdB(0x200963d7), XdB(0x221e5ccd), XdB(0x2455f870), michael@0: XdB(0x26b2770b), XdB(0x29363e2b), XdB(0x2be3db5c), XdB(0x2ebe06b6), michael@0: XdB(0x31c7a55b), XdB(0x3503ccd4), XdB(0x3875c5aa), XdB(0x3c210f44), michael@0: XdB(0x4009632b), XdB(0x4432b8cf), XdB(0x48a149bc), XdB(0x4d59959e), michael@0: XdB(0x52606733), XdB(0x57bad899), XdB(0x5d6e593a), XdB(0x6380b298), michael@0: XdB(0x69f80e9a), XdB(0x70dafda8), XdB(0x78307d76), XdB(0x7fffffff), michael@0: }; michael@0: michael@0: static void render_line(int n, int x0,int x1,int y0,int y1,ogg_int32_t *d){ michael@0: int dy=y1-y0; michael@0: int adx=x1-x0; michael@0: int ady=abs(dy); michael@0: int base=dy/adx; michael@0: int sy=(dy<0?base-1:base+1); michael@0: int x=x0; michael@0: int y=y0; michael@0: int err=0; michael@0: michael@0: if(n>x1)n=x1; michael@0: ady-=abs(base*adx); michael@0: michael@0: if(x=adx){ michael@0: err-=adx; michael@0: y+=sy; michael@0: }else{ michael@0: y+=base; michael@0: } michael@0: d[x]= MULT31_SHIFT15(d[x],FLOOR_fromdB_LOOKUP[y]); michael@0: } michael@0: } michael@0: michael@0: static void *floor1_inverse1(vorbis_block *vb,vorbis_look_floor *in){ michael@0: vorbis_look_floor1 *look=(vorbis_look_floor1 *)in; michael@0: vorbis_info_floor1 *info=look->vi; michael@0: codec_setup_info *ci=(codec_setup_info *)vb->vd->vi->codec_setup; michael@0: michael@0: int i,j,k; michael@0: codebook *books=ci->fullbooks; michael@0: michael@0: /* unpack wrapped/predicted values from stream */ michael@0: if(oggpack_read(&vb->opb,1)==1){ michael@0: int *fit_value=(int *)_vorbis_block_alloc(vb,(look->posts)*sizeof(*fit_value)); michael@0: michael@0: fit_value[0]=oggpack_read(&vb->opb,ilog(look->quant_q-1)); michael@0: fit_value[1]=oggpack_read(&vb->opb,ilog(look->quant_q-1)); michael@0: michael@0: /* partition by partition */ michael@0: /* partition by partition */ michael@0: for(i=0,j=2;ipartitions;i++){ michael@0: int classv=info->partitionclass[i]; michael@0: int cdim=info->class_dim[classv]; michael@0: int csubbits=info->class_subs[classv]; michael@0: int csub=1<class_book[classv],&vb->opb); michael@0: michael@0: if(cval==-1)goto eop; michael@0: } michael@0: michael@0: for(k=0;kclass_subbook[classv][cval&(csub-1)]; michael@0: cval>>=csubbits; michael@0: if(book>=0){ michael@0: if((fit_value[j+k]=vorbis_book_decode(books+book,&vb->opb))==-1) michael@0: goto eop; michael@0: }else{ michael@0: fit_value[j+k]=0; michael@0: } michael@0: } michael@0: j+=cdim; michael@0: } michael@0: michael@0: /* unwrap positive values and reconsitute via linear interpolation */ michael@0: for(i=2;iposts;i++){ michael@0: int predicted=render_point(info->postlist[look->loneighbor[i-2]], michael@0: info->postlist[look->hineighbor[i-2]], michael@0: fit_value[look->loneighbor[i-2]], michael@0: fit_value[look->hineighbor[i-2]], michael@0: info->postlist[i]); michael@0: int hiroom=look->quant_q-predicted; michael@0: int loroom=predicted; michael@0: int room=(hiroom=room){ michael@0: if(hiroom>loroom){ michael@0: val = val-loroom; michael@0: }else{ michael@0: val = -1-(val-hiroom); michael@0: } michael@0: }else{ michael@0: if(val&1){ michael@0: val= -((val+1)>>1); michael@0: }else{ michael@0: val>>=1; michael@0: } michael@0: } michael@0: michael@0: fit_value[i]=(val+predicted)&0x7fff;; michael@0: fit_value[look->loneighbor[i-2]]&=0x7fff; michael@0: fit_value[look->hineighbor[i-2]]&=0x7fff; michael@0: michael@0: }else{ michael@0: fit_value[i]=predicted|0x8000; michael@0: } michael@0: michael@0: } michael@0: michael@0: return(fit_value); michael@0: } michael@0: eop: michael@0: return(NULL); michael@0: } michael@0: michael@0: static int floor1_inverse2(vorbis_block *vb,vorbis_look_floor *in,void *memo, michael@0: ogg_int32_t *out){ michael@0: vorbis_look_floor1 *look=(vorbis_look_floor1 *)in; michael@0: vorbis_info_floor1 *info=look->vi; michael@0: michael@0: codec_setup_info *ci=(codec_setup_info *)vb->vd->vi->codec_setup; michael@0: int n=ci->blocksizes[vb->W]/2; michael@0: int j; michael@0: michael@0: if(memo){ michael@0: /* render the lines */ michael@0: int *fit_value=(int *)memo; michael@0: int hx=0; michael@0: int lx=0; michael@0: int ly=fit_value[0]*info->mult; michael@0: /* guard lookup against out-of-rage values */ michael@0: ly=(ly<0?0:ly>255?255:ly); michael@0: michael@0: for(j=1;jposts;j++){ michael@0: int current=look->forward_index[j]; michael@0: int hy=fit_value[current]&0x7fff; michael@0: if(hy==fit_value[current]){ michael@0: michael@0: hx=info->postlist[current]; michael@0: hy*=info->mult; michael@0: /* guard lookup against out-of-rage values */ michael@0: hy=(hy<0?0:hy>255?255:hy); michael@0: michael@0: michael@0: render_line(n,lx,hx,ly,hy,out); michael@0: michael@0: lx=hx; michael@0: ly=hy; michael@0: } michael@0: } michael@0: for(j=hx;j