ra288.c
上传用户:wstnjxml
上传日期:2014-04-03
资源大小:7248k
文件大小:7k
源码类别:

Windows CE

开发平台:

C/C++

  1. /*
  2.  * RealAudio 2.0 (28.8K)
  3.  * Copyright (c) 2003 the ffmpeg project
  4.  *
  5.  * This library is free software; you can redistribute it and/or
  6.  * modify it under the terms of the GNU Lesser General Public
  7.  * License as published by the Free Software Foundation; either
  8.  * version 2 of the License, or (at your option) any later version.
  9.  *
  10.  * This library is distributed in the hope that it will be useful,
  11.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13.  * Lesser General Public License for more details.
  14.  *
  15.  * You should have received a copy of the GNU Lesser General Public
  16.  * License along with this library; if not, write to the Free Software
  17.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  18.  */
  19. #include "avcodec.h"
  20. #include "ra288.h"
  21.  
  22. typedef struct {
  23. float history[8];
  24. float output[40];
  25. float pr1[36];
  26. float pr2[10];
  27. int phase, phasep;
  28. float st1a[111],st1b[37],st1[37];
  29. float st2a[38],st2b[11],st2[11];
  30. float sb[41];
  31. float lhist[10];
  32. } Real288_internal;
  33. static int ra288_decode_init(AVCodecContext * avctx)
  34. {
  35. Real288_internal *glob=avctx->priv_data;
  36. memset(glob,0,sizeof(Real288_internal));
  37. return 0;
  38. }
  39. static void prodsum(float *tgt, float *src, int len, int n);
  40. static void co(int n, int i, int j, float *in, float *out, float *st1, float *st2, const float *table);
  41. static int pred(float *in, float *tgt, int n);
  42. static void colmult(float *tgt, float *m1, const float *m2, int n);
  43. /* initial decode */
  44. static void unpack(unsigned short *tgt, unsigned char *src, unsigned int len)
  45. {
  46.   int x,y,z;
  47.   int n,temp;
  48.   int buffer[len];
  49.   for (x=0;x<len;tgt[x++]=0)
  50.     buffer[x]=9+(x&1);
  51.   for (x=y=z=0;x<len/*was 38*/;x++) {
  52.     n=buffer[y]-z;
  53.     temp=src[x];
  54.     if (n<8) temp&=255>>(8-n);
  55.     tgt[y]+=temp<<z;
  56.     if (n<=8) {
  57.       tgt[++y]+=src[x]>>n;
  58.       z=8-n;
  59.     } else z+=8;
  60.   }
  61. }
  62. static void update(Real288_internal *glob)
  63. {
  64.   int x,y;
  65.   float buffer1[40],temp1[37];
  66.   float buffer2[8],temp2[11];
  67.   for (x=0,y=glob->phasep+5;x<40;buffer1[x++]=glob->output[(y++)%40]);
  68.   co(36,40,35,buffer1,temp1,glob->st1a,glob->st1b,table1);
  69.   if (pred(temp1,glob->st1,36))
  70.     colmult(glob->pr1,glob->st1,table1a,36);
  71.   for (x=0,y=glob->phase+1;x<8;buffer2[x++]=glob->history[(y++)%8]);
  72.   co(10,8,20,buffer2,temp2,glob->st2a,glob->st2b,table2);
  73.   if (pred(temp2,glob->st2,10))
  74.     colmult(glob->pr2,glob->st2,table2a,10);
  75. }
  76. /* Decode and produce output */
  77. static void decode(Real288_internal *glob, unsigned int input)
  78. {
  79.   unsigned int x,y;
  80.   float f;
  81.   double sum,sumsum;
  82.   float *p1,*p2;
  83.   float buffer[5];
  84.   const float *table;
  85.   for (x=36;x--;glob->sb[x+5]=glob->sb[x]);
  86.   for (x=5;x--;) {
  87.     p1=glob->sb+x;p2=glob->pr1;
  88.     for (sum=0,y=36;y--;sum-=(*(++p1))*(*(p2++)));
  89.     glob->sb[x]=sum;
  90.   }
  91.   f=amptable[input&7];
  92.   table=codetable+(input>>3)*5;
  93.   /* convert log and do rms */
  94.   for (sum=32,x=10;x--;sum-=glob->pr2[x]*glob->lhist[x]);
  95.   if (sum<0) sum=0; else if (sum>60) sum=60;
  96.   sumsum=exp(sum*0.1151292546497)*f; /* pow(10.0,sum/20)*f */
  97.   for (sum=0,x=5;x--;) { buffer[x]=table[x]*sumsum; sum+=buffer[x]*buffer[x]; }
  98.   if ((sum/=5)<1) sum=1;
  99.   /* shift and store */
  100.   for (x=10;--x;glob->lhist[x]=glob->lhist[x-1]);
  101.   *glob->lhist=glob->history[glob->phase]=10*log10(sum)-32;
  102.   for (x=1;x<5;x++) for (y=x;y--;buffer[x]-=glob->pr1[x-y-1]*buffer[y]);
  103.   /* output */
  104.   for (x=0;x<5;x++) {
  105.     f=glob->sb[4-x]+buffer[x];
  106.     if (f>4095) f=4095; else if (f<-4095) f=-4095;
  107.     glob->output[glob->phasep+x]=glob->sb[4-x]=f;
  108.   }
  109. }
  110. /* column multiply */
  111. static void colmult(float *tgt, float *m1, const float *m2, int n)
  112. {
  113.   while (n--)
  114.     *(tgt++)=(*(m1++))*(*(m2++));
  115. }
  116. static int pred(float *in, float *tgt, int n)
  117. {
  118.   int x,y;
  119.   float *p1,*p2;
  120.   double f0,f1,f2;
  121.   float temp;
  122.   if (in[n]==0) return 0;
  123.   if ((f0=*in)<=0) return 0;
  124.   for (x=1;;x++) {
  125.     if (n<x) return 1;
  126.     p1=in+x;
  127.     p2=tgt;
  128.     f1=*(p1--);
  129.     for (y=x;--y;f1+=(*(p1--))*(*(p2++)));
  130.     p1=tgt+x-1;
  131.     p2=tgt;
  132.     *(p1--)=f2=-f1/f0;
  133.     for (y=x>>1;y--;) {
  134.       temp=*p2+*p1*f2;
  135.       *(p1--)+=*p2*f2;
  136.       *(p2++)=temp;
  137.     }
  138.     if ((f0+=f1*f2)<0) return 0;
  139.   }
  140. }
  141. static void co(int n, int i, int j, float *in, float *out, float *st1, float *st2, const float *table)
  142. {
  143.   int a,b,c;
  144.   unsigned int x;
  145.   float *fp;
  146.   float buffer1[37];
  147.   float buffer2[37];
  148.   float work[111];
  149.   /* rotate and multiply */
  150.   c=(b=(a=n+i)+j)-i;
  151.   fp=st1+i;
  152.   for (x=0;x<b;x++) {
  153.     if (x==c) fp=in;
  154.     work[x]=*(table++)*(*(st1++)=*(fp++));
  155.   }
  156.   
  157.   prodsum(buffer1,work+n,i,n);
  158.   prodsum(buffer2,work+a,j,n);
  159.   for (x=0;x<=n;x++) {
  160.     *st2=*st2*(0.5625)+buffer1[x];
  161.     out[x]=*(st2++)+buffer2[x];
  162.   }
  163.   *out*=1.00390625; /* to prevent clipping */
  164. }
  165. /* product sum (lsf) */
  166. static void prodsum(float *tgt, float *src, int len, int n)
  167. {
  168.   unsigned int x;
  169.   float *p1,*p2;
  170.   double sum;
  171.   while (n>=0)
  172.   {
  173.     p1=(p2=src)-n;
  174.     for (sum=0,x=len;x--;sum+=(*p1++)*(*p2++));
  175.     tgt[n--]=sum;
  176.   }
  177. }
  178. static void * decode_block(AVCodecContext * avctx, unsigned char *in, signed short int *out,unsigned len)
  179. {
  180.   int x,y;
  181.   Real288_internal *glob=avctx->priv_data;
  182.   unsigned short int buffer[len];
  183.   unpack(buffer,in,len);
  184.   for (x=0;x<32;x++)
  185.   {
  186.     glob->phasep=(glob->phase=x&7)*5;
  187.     decode(glob,buffer[x]);
  188.     for (y=0;y<5;*(out++)=8*glob->output[glob->phasep+(y++)]);
  189.     if (glob->phase==3) update(glob);
  190.   }
  191.   return out;
  192. }
  193. /* Decode a block (celp) */
  194. static int ra288_decode_frame(AVCodecContext * avctx,
  195.             void *data, int *data_size,
  196.             uint8_t * buf, int buf_size)
  197. {
  198.   if(avctx->extradata_size>=6)
  199.   {
  200. //((short*)(avctx->extradata))[0]; /* subpacket size */
  201. //((short*)(avctx->extradata))[1]; /* subpacket height */
  202. //((short*)(avctx->extradata))[2]; /* subpacket flavour */
  203. //((short*)(avctx->extradata))[3]; /* coded frame size */
  204. //((short*)(avctx->extradata))[4]; /* codec's data length  */
  205. //((short*)(avctx->extradata))[5...] /* codec's data */
  206.     int bret;
  207.     void *datao;
  208.     int w=avctx->block_align; /* 228 */
  209.     int h=((short*)(avctx->extradata))[1]; /* 12 */
  210.     int cfs=((short*)(avctx->extradata))[3]; /* coded frame size 38 */
  211.     int i,j;
  212.     if(buf_size<w*h)
  213.     {
  214. av_log(avctx, AV_LOG_ERROR, "ffra288: Error! Input buffer is too small [%d<%d]n",buf_size,w*h);
  215. return 0;
  216.     }
  217.     datao = data;
  218.     bret = 0;
  219.     for (j = 0; j < h/2; j++)
  220. for (i = 0; i < h; i++)
  221.     {
  222.     data=decode_block(avctx,&buf[j*cfs+cfs*i*h/2],(signed short *)data,cfs);
  223.     bret += cfs;
  224.     }
  225.     *data_size = (char *)data - (char *)datao;
  226.     return bret;
  227.   }
  228.   else
  229.   {
  230.     av_log(avctx, AV_LOG_ERROR, "ffra288: Error: need extra data!!!n");
  231.     return 0;
  232.   }
  233. }
  234. AVCodec ra_288_decoder =
  235. {
  236.     "real_288",
  237.     CODEC_TYPE_AUDIO,
  238.     CODEC_ID_RA_288,
  239.     sizeof(Real288_internal),
  240.     ra288_decode_init,
  241.     NULL,
  242.     NULL,
  243.     ra288_decode_frame,
  244. };