Mercurial > mplayer.hg
view libmpcodecs/native/decode144.c @ 15889:efb8b8fa323e
Add missing escapes, this should now cover all shell special characters AFAICS
author | ranma |
---|---|
date | Sat, 02 Jul 2005 19:12:01 +0000 |
parents | 597ad4eb02fc |
children |
line wrap: on
line source
#include "common1428.h" #include "decode144.h" #include "tables144.h" /* Initialize internal variable structure */ Real_144 *init_144(void) { Real_internal *glob; if ((glob=malloc(sizeof(Real_internal)))) memset(glob,0,sizeof(Real_internal)); glob->resetflag=1; glob->swapbuf1=glob->swapb1a; glob->swapbuf2=glob->swapb2a; glob->swapbuf1alt=glob->swapb1b; glob->swapbuf2alt=glob->swapb2b; memcpy(glob->wavtable1,wavtable1,sizeof(wavtable1)); memcpy(glob->wavtable2,wavtable2,sizeof(wavtable2)); return (Real_144 *)glob; } /* Free internal variable structure */ void free_144(Real_144 *global) { if (!global) return; free(global); } /* Uncompress one block (20 bytes -> 160*2 bytes) */ void decode_144(Real_144 *global, unsigned char *source, signed short *target) { unsigned int a,b,c; long s; signed short *shptr; unsigned int *lptr,*temp; const short **dptr; Real_internal *glob; if (!global) return; glob = (Real_internal *)global; unpack_input(source,glob->unpacked); glob->iptr=glob->unpacked; glob->val=decodetable[0][(*(glob->iptr++))<<1]; dptr=decodetable+1; lptr=glob->swapbuf1; while (lptr<glob->swapbuf1+10) *(lptr++)=(*(dptr++))[(*(glob->iptr++))<<1]; do_voice(glob->swapbuf1,glob->swapbuf2); a=t_sqrt(glob->val*glob->oldval)>>12; for (c=0;c<NBLOCKS;c++) { if (c==(NBLOCKS-1)) { dec1(glob,glob->swapbuf1,glob->swapbuf2,3,glob->val); } else { if (c*2==(NBLOCKS-2)) { if (glob->oldval<glob->val) { dec2(glob,glob->swapbuf1,glob->swapbuf2,3,a,glob->swapbuf2alt,c); } else { dec2(glob,glob->swapbuf1alt,glob->swapbuf2alt,3,a,glob->swapbuf2,c); } } else { if (c*2<(NBLOCKS-2)) { dec2(glob,glob->swapbuf1alt,glob->swapbuf2alt,3,glob->oldval,glob->swapbuf2,c); } else { dec2(glob,glob->swapbuf1,glob->swapbuf2,3,glob->val,glob->swapbuf2alt,c); } } } } /* do output */ for (b=0,c=0;c<4;c++) { glob->gval=glob->gbuf1[c*2]; glob->gsp=glob->gbuf2+b; do_output_subblock(glob,glob->resetflag); glob->resetflag=0; shptr=glob->output_buffer; while (shptr<glob->output_buffer+BLOCKSIZE) { s=*(shptr++)<<2; *target=s; if (s>32767) *target=32767; if (s<-32767) *target=-32768; target++; } b+=30; } glob->oldval=glob->val; temp=glob->swapbuf1alt; glob->swapbuf1alt=glob->swapbuf1; glob->swapbuf1=temp; temp=glob->swapbuf2alt; glob->swapbuf2alt=glob->swapbuf2; glob->swapbuf2=temp; } /* lookup square roots in table */ static int t_sqrt(unsigned int x) { int s=0; while (x>0xfff) { s++; x=x>>2; } return (sqrt_table[x]<<s)<<2; } /* do 'voice' */ static void do_voice(int *a1, int *a2) { int buffer[10]; int *b1,*b2; int x,y; int *ptr,*tmp; b1=buffer; b2=a2; for (x=0;x<10;x++) { b1[x]=(*a1)<<4; if(x>0) { ptr=b2+x; for (y=0;y<=x-1;y++) b1[y]=(((*a1)*(*(--ptr)))>>12)+b2[y]; } tmp=b1; b1=b2; b2=tmp; a1++; } ptr=a2+10; while (ptr>a2) (*a2++)>>=4; } /* do quarter-block output */ static void do_output_subblock(Real_internal *glob, int x) { int a,b,c,d,e,f,g; if (x==1) memset(glob->buffer,0,20); if ((*glob->iptr)==0) a=0; else a=(*glob->iptr)+HALFBLOCK-1; glob->iptr++; b=*(glob->iptr++); c=*(glob->iptr++); d=*(glob->iptr++); if (a) rotate_block(glob->buffer_2,glob->buffer_a,a); memcpy(glob->buffer_b,etable1+b*BLOCKSIZE,BLOCKSIZE*2); e=((ftable1[b]>>4)*glob->gval)>>8; memcpy(glob->buffer_c,etable2+c*BLOCKSIZE,BLOCKSIZE*2); f=((ftable2[c]>>4)*glob->gval)>>8; if (a) g=irms(glob->buffer_a,glob->gval)>>12; else g=0; add_wav(glob,d,a,g,e,f,glob->buffer_a,glob->buffer_b,glob->buffer_c,glob->buffer_d); memmove(glob->buffer_2,glob->buffer_2+BLOCKSIZE,(BUFFERSIZE-BLOCKSIZE)*2); memcpy(glob->buffer_2+BUFFERSIZE-BLOCKSIZE,glob->buffer_d,BLOCKSIZE*2); final(glob,glob->gsp,glob->buffer_d,glob->output_buffer,glob->buffer,BLOCKSIZE); } /* rotate block */ static void rotate_block(short *source, short *target, int offset) { short *end; short *ptr1; short *ptr2; short *ptr3; ptr2=source+BUFFERSIZE; ptr3=ptr1=ptr2-offset; end=target+BLOCKSIZE; while (target<end) { *(target++)=*(ptr3++); if (ptr3==ptr2) ptr3=ptr1; } } /* inverse root mean square */ static int irms(short *data, int factor) { short *p1,*p2; unsigned int sum; p2=(p1=data)+BLOCKSIZE; for (sum=0;p2>p1;p1++) sum+=(*p1)*(*p1); if (sum==0) return 0; /* OOPS - division by zero */ return (0x20000000/(t_sqrt(sum)>>8))*factor; } /* multiply/add wavetable */ static void add_wav(Real_internal *glob, int n, int f, int m1, int m2, int m3, short *s1, short *s2, short *s3, short *dest) { int a,b,c; int x; short *ptr,*ptr2; ptr=glob->wavtable1+n*9; ptr2=glob->wavtable2+n*9; if (f!=0) { a=((*ptr)*m1)>>((*ptr2)+1); } else { a=0; } ptr++;ptr2++; b=((*ptr)*m2)>>((*ptr2)+1); ptr++;ptr2++; c=((*ptr)*m3)>>((*ptr2)+1); ptr2=(ptr=dest)+BLOCKSIZE; if (f!=0) while (ptr<ptr2) *(ptr++)=((*(s1++))*a+(*(s2++))*b+(*(s3++))*c)>>12; else while (ptr<ptr2) *(ptr++)=((*(s2++))*b+(*(s3++))*c)>>12; } static void final(Real_internal *glob, short *i1, short *i2, void *out, int *statbuf, int len) { int x,sum; int buffer[10]; short *ptr; short *ptr2; memcpy(glob->work,statbuf,20); memcpy(glob->work+10,i2,len*2); buffer[9]=i1[0]; buffer[8]=i1[1]; buffer[7]=i1[2]; buffer[6]=i1[3]; buffer[5]=i1[4]; buffer[4]=i1[5]; buffer[3]=i1[6]; buffer[2]=i1[7]; buffer[1]=i1[8]; buffer[0]=i1[9]; ptr2=(ptr=glob->work)+len; while (ptr<ptr2) { for(sum=0,x=0;x<=9;x++) sum+=buffer[x]*(ptr[x]); sum=sum>>12; x=ptr[10]-sum; if (x<-32768 || x>32767) { memset(out,0,len*2); memset(statbuf,0,20); return; } ptr[10]=x; ptr++; } memcpy(out,ptr+10-len,len*2); memcpy(statbuf,ptr,20); } /* Decode 20-byte input */ static void unpack_input(unsigned char *input, unsigned int *output) { unsigned int outbuffer[28]; unsigned short inbuffer[10]; unsigned int x; unsigned int *ptr; /* fix endianness */ for (x=0;x<20;x+=2) inbuffer[x/2]=(input[x]<<8)+input[x+1]; /* unpack */ ptr=outbuffer; *(ptr++)=27; *(ptr++)=(inbuffer[0]>>10)&0x3f; *(ptr++)=(inbuffer[0]>>5)&0x1f; *(ptr++)=inbuffer[0]&0x1f; *(ptr++)=(inbuffer[1]>>12)&0xf; *(ptr++)=(inbuffer[1]>>8)&0xf; *(ptr++)=(inbuffer[1]>>5)&7; *(ptr++)=(inbuffer[1]>>2)&7; *(ptr++)=((inbuffer[1]<<1)&6)|((inbuffer[2]>>15)&1); *(ptr++)=(inbuffer[2]>>12)&7; *(ptr++)=(inbuffer[2]>>10)&3; *(ptr++)=(inbuffer[2]>>5)&0x1f; *(ptr++)=((inbuffer[2]<<2)&0x7c)|((inbuffer[3]>>14)&3); *(ptr++)=(inbuffer[3]>>6)&0xff; *(ptr++)=((inbuffer[3]<<1)&0x7e)|((inbuffer[4]>>15)&1); *(ptr++)=(inbuffer[4]>>8)&0x7f; *(ptr++)=(inbuffer[4]>>1)&0x7f; *(ptr++)=((inbuffer[4]<<7)&0x80)|((inbuffer[5]>>9)&0x7f); *(ptr++)=(inbuffer[5]>>2)&0x7f; *(ptr++)=((inbuffer[5]<<5)&0x60)|((inbuffer[6]>>11)&0x1f); *(ptr++)=(inbuffer[6]>>4)&0x7f; *(ptr++)=((inbuffer[6]<<4)&0xf0)|((inbuffer[7]>>12)&0xf); *(ptr++)=(inbuffer[7]>>5)&0x7f; *(ptr++)=((inbuffer[7]<<2)&0x7c)|((inbuffer[8]>>14)&3); *(ptr++)=(inbuffer[8]>>7)&0x7f; *(ptr++)=((inbuffer[8]<<1)&0xfe)|((inbuffer[9]>>15)&1); *(ptr++)=(inbuffer[9]>>8)&0x7f; *(ptr++)=(inbuffer[9]>>1)&0x7f; *(output++)=outbuffer[11]; for (x=1;x<11;*(output++)=outbuffer[x++]); ptr=outbuffer+12; for (x=0;x<16;x+=4) { *(output++)=ptr[x]; *(output++)=ptr[x+2]; *(output++)=ptr[x+3]; *(output++)=ptr[x+1]; } } static unsigned int rms(int *data, int f) { int *c; int x; int d; unsigned int res; int b; c=data; b=0; res=0x10000; for (x=0;x<10;x++) { res=(((0x1000000-(*c)*(*c))>>12)*res)>>12; if (res==0) return 0; if (res<=0x3fff) { while (res<=0x3fff) { b++; res<<=2; } } else { if (res>0x10000) return 0; /* We're screwed, might as well go out with a bang. :P */ } c++; } if (res>0) res=t_sqrt(res); res>>=(b+10); res=(res*f)>>10; return res; } static void dec1(Real_internal *glob, int *data, int *inp, int n, int f) { short *ptr,*end; *(glob->decptr++)=rms(data,f); glob->decptr++; end=(ptr=glob->decsp)+(n*10); while (ptr<end) *(ptr++)=*(inp++); } static void dec2(Real_internal *glob, int *data, int *inp, int n, int f, int *inp2, int l) { unsigned int *ptr1,*ptr2; int work[10]; int a,b; int x; int result; if(l+1<NBLOCKS/2) a=NBLOCKS-(l+1); else a=l+1; b=NBLOCKS-a; if (l==0) { glob->decsp=glob->sptr=glob->gbuf2; glob->decptr=glob->gbuf1; } ptr1=inp; ptr2=inp2; for (x=0;x<10*n;x++) *(glob->sptr++)=(a*(*ptr1++)+b*(*ptr2++))>>2; result=eq(glob,glob->decsp,work); if (result==1) { dec1(glob,data,inp,n,f); } else { *(glob->decptr++)=rms(work,f); glob->decptr++; } glob->decsp+=n*10; } static int eq(Real_internal *glob, short *in, int *target) { int retval; int a; int b; int c; unsigned int u; short *sptr; int *ptr1,*ptr2,*ptr3; int *bp1,*bp2,*temp; retval=0; bp1=glob->buffer1; bp2=glob->buffer2; ptr2=(ptr3=glob->buffer2)+9; sptr=in; while (ptr2>=ptr3) *(ptr3++)=*(sptr++); target+=9; a=bp2[9]; *target=a; if (a+0x1000>0x1fff) return 0; /* We're screwed, might as well go out with a bang. :P */ c=8;u=a; while (c>=0) { if (u==0x1000) u++; if (u==0xfffff000) u--; b=0x1000-((u*u)>>12); if (b==0) b++; ptr2=bp1; ptr1=(ptr3=bp2)+c; for (u=0;u<=c;u++) *(ptr2++)=((*(ptr3++)-(((*target)*(*(ptr1--)))>>12))*(0x1000000/b))>>12; *(--target)=u=bp1[(c--)]; if ((u+0x1000)>0x1fff) retval=1; temp=bp2; bp2=bp1; bp1=temp; } return retval; }