cannam@86: /********************************************************************
cannam@86:  *                                                                  *
cannam@86:  * THIS FILE IS PART OF THE OggVorbis SOFTWARE CODEC SOURCE CODE.   *
cannam@86:  * USE, DISTRIBUTION AND REPRODUCTION OF THIS LIBRARY SOURCE IS     *
cannam@86:  * GOVERNED BY A BSD-STYLE SOURCE LICENSE INCLUDED WITH THIS SOURCE *
cannam@86:  * IN 'COPYING'. PLEASE READ THESE TERMS BEFORE DISTRIBUTING.       *
cannam@86:  *                                                                  *
cannam@86:  * THE OggVorbis SOURCE CODE IS (C) COPYRIGHT 1994-2009             *
cannam@86:  * by the Xiph.Org Foundation http://www.xiph.org/                  *
cannam@86:  *                                                                  *
cannam@86:  ********************************************************************
cannam@86: 
cannam@86:  function: *unnormalized* fft transform
cannam@86:  last mod: $Id: smallft.c 16227 2009-07-08 06:58:46Z xiphmont $
cannam@86: 
cannam@86:  ********************************************************************/
cannam@86: 
cannam@86: /* FFT implementation from OggSquish, minus cosine transforms,
cannam@86:  * minus all but radix 2/4 case.  In Vorbis we only need this
cannam@86:  * cut-down version.
cannam@86:  *
cannam@86:  * To do more than just power-of-two sized vectors, see the full
cannam@86:  * version I wrote for NetLib.
cannam@86:  *
cannam@86:  * Note that the packing is a little strange; rather than the FFT r/i
cannam@86:  * packing following R_0, I_n, R_1, I_1, R_2, I_2 ... R_n-1, I_n-1,
cannam@86:  * it follows R_0, R_1, I_1, R_2, I_2 ... R_n-1, I_n-1, I_n like the
cannam@86:  * FORTRAN version
cannam@86:  */
cannam@86: 
cannam@86: #include <stdlib.h>
cannam@86: #include <string.h>
cannam@86: #include <math.h>
cannam@86: #include "smallft.h"
cannam@86: #include "os.h"
cannam@86: #include "misc.h"
cannam@86: 
cannam@86: static void drfti1(int n, float *wa, int *ifac){
cannam@86:   static int ntryh[4] = { 4,2,3,5 };
cannam@86:   static float tpi = 6.28318530717958648f;
cannam@86:   float arg,argh,argld,fi;
cannam@86:   int ntry=0,i,j=-1;
cannam@86:   int k1, l1, l2, ib;
cannam@86:   int ld, ii, ip, is, nq, nr;
cannam@86:   int ido, ipm, nfm1;
cannam@86:   int nl=n;
cannam@86:   int nf=0;
cannam@86: 
cannam@86:  L101:
cannam@86:   j++;
cannam@86:   if (j < 4)
cannam@86:     ntry=ntryh[j];
cannam@86:   else
cannam@86:     ntry+=2;
cannam@86: 
cannam@86:  L104:
cannam@86:   nq=nl/ntry;
cannam@86:   nr=nl-ntry*nq;
cannam@86:   if (nr!=0) goto L101;
cannam@86: 
cannam@86:   nf++;
cannam@86:   ifac[nf+1]=ntry;
cannam@86:   nl=nq;
cannam@86:   if(ntry!=2)goto L107;
cannam@86:   if(nf==1)goto L107;
cannam@86: 
cannam@86:   for (i=1;i<nf;i++){
cannam@86:     ib=nf-i+1;
cannam@86:     ifac[ib+1]=ifac[ib];
cannam@86:   }
cannam@86:   ifac[2] = 2;
cannam@86: 
cannam@86:  L107:
cannam@86:   if(nl!=1)goto L104;
cannam@86:   ifac[0]=n;
cannam@86:   ifac[1]=nf;
cannam@86:   argh=tpi/n;
cannam@86:   is=0;
cannam@86:   nfm1=nf-1;
cannam@86:   l1=1;
cannam@86: 
cannam@86:   if(nfm1==0)return;
cannam@86: 
cannam@86:   for (k1=0;k1<nfm1;k1++){
cannam@86:     ip=ifac[k1+2];
cannam@86:     ld=0;
cannam@86:     l2=l1*ip;
cannam@86:     ido=n/l2;
cannam@86:     ipm=ip-1;
cannam@86: 
cannam@86:     for (j=0;j<ipm;j++){
cannam@86:       ld+=l1;
cannam@86:       i=is;
cannam@86:       argld=(float)ld*argh;
cannam@86:       fi=0.f;
cannam@86:       for (ii=2;ii<ido;ii+=2){
cannam@86:         fi+=1.f;
cannam@86:         arg=fi*argld;
cannam@86:         wa[i++]=cos(arg);
cannam@86:         wa[i++]=sin(arg);
cannam@86:       }
cannam@86:       is+=ido;
cannam@86:     }
cannam@86:     l1=l2;
cannam@86:   }
cannam@86: }
cannam@86: 
cannam@86: static void fdrffti(int n, float *wsave, int *ifac){
cannam@86: 
cannam@86:   if (n == 1) return;
cannam@86:   drfti1(n, wsave+n, ifac);
cannam@86: }
cannam@86: 
cannam@86: static void dradf2(int ido,int l1,float *cc,float *ch,float *wa1){
cannam@86:   int i,k;
cannam@86:   float ti2,tr2;
cannam@86:   int t0,t1,t2,t3,t4,t5,t6;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t0=(t2=l1*ido);
cannam@86:   t3=ido<<1;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     ch[t1<<1]=cc[t1]+cc[t2];
cannam@86:     ch[(t1<<1)+t3-1]=cc[t1]-cc[t2];
cannam@86:     t1+=ido;
cannam@86:     t2+=ido;
cannam@86:   }
cannam@86: 
cannam@86:   if(ido<2)return;
cannam@86:   if(ido==2)goto L105;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=t0;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     t3=t2;
cannam@86:     t4=(t1<<1)+(ido<<1);
cannam@86:     t5=t1;
cannam@86:     t6=t1+t1;
cannam@86:     for(i=2;i<ido;i+=2){
cannam@86:       t3+=2;
cannam@86:       t4-=2;
cannam@86:       t5+=2;
cannam@86:       t6+=2;
cannam@86:       tr2=wa1[i-2]*cc[t3-1]+wa1[i-1]*cc[t3];
cannam@86:       ti2=wa1[i-2]*cc[t3]-wa1[i-1]*cc[t3-1];
cannam@86:       ch[t6]=cc[t5]+ti2;
cannam@86:       ch[t4]=ti2-cc[t5];
cannam@86:       ch[t6-1]=cc[t5-1]+tr2;
cannam@86:       ch[t4-1]=cc[t5-1]-tr2;
cannam@86:     }
cannam@86:     t1+=ido;
cannam@86:     t2+=ido;
cannam@86:   }
cannam@86: 
cannam@86:   if(ido%2==1)return;
cannam@86: 
cannam@86:  L105:
cannam@86:   t3=(t2=(t1=ido)-1);
cannam@86:   t2+=t0;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     ch[t1]=-cc[t2];
cannam@86:     ch[t1-1]=cc[t3];
cannam@86:     t1+=ido<<1;
cannam@86:     t2+=ido;
cannam@86:     t3+=ido;
cannam@86:   }
cannam@86: }
cannam@86: 
cannam@86: static void dradf4(int ido,int l1,float *cc,float *ch,float *wa1,
cannam@86:             float *wa2,float *wa3){
cannam@86:   static float hsqt2 = .70710678118654752f;
cannam@86:   int i,k,t0,t1,t2,t3,t4,t5,t6;
cannam@86:   float ci2,ci3,ci4,cr2,cr3,cr4,ti1,ti2,ti3,ti4,tr1,tr2,tr3,tr4;
cannam@86:   t0=l1*ido;
cannam@86: 
cannam@86:   t1=t0;
cannam@86:   t4=t1<<1;
cannam@86:   t2=t1+(t1<<1);
cannam@86:   t3=0;
cannam@86: 
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     tr1=cc[t1]+cc[t2];
cannam@86:     tr2=cc[t3]+cc[t4];
cannam@86: 
cannam@86:     ch[t5=t3<<2]=tr1+tr2;
cannam@86:     ch[(ido<<2)+t5-1]=tr2-tr1;
cannam@86:     ch[(t5+=(ido<<1))-1]=cc[t3]-cc[t4];
cannam@86:     ch[t5]=cc[t2]-cc[t1];
cannam@86: 
cannam@86:     t1+=ido;
cannam@86:     t2+=ido;
cannam@86:     t3+=ido;
cannam@86:     t4+=ido;
cannam@86:   }
cannam@86: 
cannam@86:   if(ido<2)return;
cannam@86:   if(ido==2)goto L105;
cannam@86: 
cannam@86: 
cannam@86:   t1=0;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     t2=t1;
cannam@86:     t4=t1<<2;
cannam@86:     t5=(t6=ido<<1)+t4;
cannam@86:     for(i=2;i<ido;i+=2){
cannam@86:       t3=(t2+=2);
cannam@86:       t4+=2;
cannam@86:       t5-=2;
cannam@86: 
cannam@86:       t3+=t0;
cannam@86:       cr2=wa1[i-2]*cc[t3-1]+wa1[i-1]*cc[t3];
cannam@86:       ci2=wa1[i-2]*cc[t3]-wa1[i-1]*cc[t3-1];
cannam@86:       t3+=t0;
cannam@86:       cr3=wa2[i-2]*cc[t3-1]+wa2[i-1]*cc[t3];
cannam@86:       ci3=wa2[i-2]*cc[t3]-wa2[i-1]*cc[t3-1];
cannam@86:       t3+=t0;
cannam@86:       cr4=wa3[i-2]*cc[t3-1]+wa3[i-1]*cc[t3];
cannam@86:       ci4=wa3[i-2]*cc[t3]-wa3[i-1]*cc[t3-1];
cannam@86: 
cannam@86:       tr1=cr2+cr4;
cannam@86:       tr4=cr4-cr2;
cannam@86:       ti1=ci2+ci4;
cannam@86:       ti4=ci2-ci4;
cannam@86: 
cannam@86:       ti2=cc[t2]+ci3;
cannam@86:       ti3=cc[t2]-ci3;
cannam@86:       tr2=cc[t2-1]+cr3;
cannam@86:       tr3=cc[t2-1]-cr3;
cannam@86: 
cannam@86:       ch[t4-1]=tr1+tr2;
cannam@86:       ch[t4]=ti1+ti2;
cannam@86: 
cannam@86:       ch[t5-1]=tr3-ti4;
cannam@86:       ch[t5]=tr4-ti3;
cannam@86: 
cannam@86:       ch[t4+t6-1]=ti4+tr3;
cannam@86:       ch[t4+t6]=tr4+ti3;
cannam@86: 
cannam@86:       ch[t5+t6-1]=tr2-tr1;
cannam@86:       ch[t5+t6]=ti1-ti2;
cannam@86:     }
cannam@86:     t1+=ido;
cannam@86:   }
cannam@86:   if(ido&1)return;
cannam@86: 
cannam@86:  L105:
cannam@86: 
cannam@86:   t2=(t1=t0+ido-1)+(t0<<1);
cannam@86:   t3=ido<<2;
cannam@86:   t4=ido;
cannam@86:   t5=ido<<1;
cannam@86:   t6=ido;
cannam@86: 
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     ti1=-hsqt2*(cc[t1]+cc[t2]);
cannam@86:     tr1=hsqt2*(cc[t1]-cc[t2]);
cannam@86: 
cannam@86:     ch[t4-1]=tr1+cc[t6-1];
cannam@86:     ch[t4+t5-1]=cc[t6-1]-tr1;
cannam@86: 
cannam@86:     ch[t4]=ti1-cc[t1+t0];
cannam@86:     ch[t4+t5]=ti1+cc[t1+t0];
cannam@86: 
cannam@86:     t1+=ido;
cannam@86:     t2+=ido;
cannam@86:     t4+=t3;
cannam@86:     t6+=ido;
cannam@86:   }
cannam@86: }
cannam@86: 
cannam@86: static void dradfg(int ido,int ip,int l1,int idl1,float *cc,float *c1,
cannam@86:                           float *c2,float *ch,float *ch2,float *wa){
cannam@86: 
cannam@86:   static float tpi=6.283185307179586f;
cannam@86:   int idij,ipph,i,j,k,l,ic,ik,is;
cannam@86:   int t0,t1,t2,t3,t4,t5,t6,t7,t8,t9,t10;
cannam@86:   float dc2,ai1,ai2,ar1,ar2,ds2;
cannam@86:   int nbd;
cannam@86:   float dcp,arg,dsp,ar1h,ar2h;
cannam@86:   int idp2,ipp2;
cannam@86: 
cannam@86:   arg=tpi/(float)ip;
cannam@86:   dcp=cos(arg);
cannam@86:   dsp=sin(arg);
cannam@86:   ipph=(ip+1)>>1;
cannam@86:   ipp2=ip;
cannam@86:   idp2=ido;
cannam@86:   nbd=(ido-1)>>1;
cannam@86:   t0=l1*ido;
cannam@86:   t10=ip*ido;
cannam@86: 
cannam@86:   if(ido==1)goto L119;
cannam@86:   for(ik=0;ik<idl1;ik++)ch2[ik]=c2[ik];
cannam@86: 
cannam@86:   t1=0;
cannam@86:   for(j=1;j<ip;j++){
cannam@86:     t1+=t0;
cannam@86:     t2=t1;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       ch[t2]=c1[t2];
cannam@86:       t2+=ido;
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86:   is=-ido;
cannam@86:   t1=0;
cannam@86:   if(nbd>l1){
cannam@86:     for(j=1;j<ip;j++){
cannam@86:       t1+=t0;
cannam@86:       is+=ido;
cannam@86:       t2= -ido+t1;
cannam@86:       for(k=0;k<l1;k++){
cannam@86:         idij=is-1;
cannam@86:         t2+=ido;
cannam@86:         t3=t2;
cannam@86:         for(i=2;i<ido;i+=2){
cannam@86:           idij+=2;
cannam@86:           t3+=2;
cannam@86:           ch[t3-1]=wa[idij-1]*c1[t3-1]+wa[idij]*c1[t3];
cannam@86:           ch[t3]=wa[idij-1]*c1[t3]-wa[idij]*c1[t3-1];
cannam@86:         }
cannam@86:       }
cannam@86:     }
cannam@86:   }else{
cannam@86: 
cannam@86:     for(j=1;j<ip;j++){
cannam@86:       is+=ido;
cannam@86:       idij=is-1;
cannam@86:       t1+=t0;
cannam@86:       t2=t1;
cannam@86:       for(i=2;i<ido;i+=2){
cannam@86:         idij+=2;
cannam@86:         t2+=2;
cannam@86:         t3=t2;
cannam@86:         for(k=0;k<l1;k++){
cannam@86:           ch[t3-1]=wa[idij-1]*c1[t3-1]+wa[idij]*c1[t3];
cannam@86:           ch[t3]=wa[idij-1]*c1[t3]-wa[idij]*c1[t3-1];
cannam@86:           t3+=ido;
cannam@86:         }
cannam@86:       }
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=ipp2*t0;
cannam@86:   if(nbd<l1){
cannam@86:     for(j=1;j<ipph;j++){
cannam@86:       t1+=t0;
cannam@86:       t2-=t0;
cannam@86:       t3=t1;
cannam@86:       t4=t2;
cannam@86:       for(i=2;i<ido;i+=2){
cannam@86:         t3+=2;
cannam@86:         t4+=2;
cannam@86:         t5=t3-ido;
cannam@86:         t6=t4-ido;
cannam@86:         for(k=0;k<l1;k++){
cannam@86:           t5+=ido;
cannam@86:           t6+=ido;
cannam@86:           c1[t5-1]=ch[t5-1]+ch[t6-1];
cannam@86:           c1[t6-1]=ch[t5]-ch[t6];
cannam@86:           c1[t5]=ch[t5]+ch[t6];
cannam@86:           c1[t6]=ch[t6-1]-ch[t5-1];
cannam@86:         }
cannam@86:       }
cannam@86:     }
cannam@86:   }else{
cannam@86:     for(j=1;j<ipph;j++){
cannam@86:       t1+=t0;
cannam@86:       t2-=t0;
cannam@86:       t3=t1;
cannam@86:       t4=t2;
cannam@86:       for(k=0;k<l1;k++){
cannam@86:         t5=t3;
cannam@86:         t6=t4;
cannam@86:         for(i=2;i<ido;i+=2){
cannam@86:           t5+=2;
cannam@86:           t6+=2;
cannam@86:           c1[t5-1]=ch[t5-1]+ch[t6-1];
cannam@86:           c1[t6-1]=ch[t5]-ch[t6];
cannam@86:           c1[t5]=ch[t5]+ch[t6];
cannam@86:           c1[t6]=ch[t6-1]-ch[t5-1];
cannam@86:         }
cannam@86:         t3+=ido;
cannam@86:         t4+=ido;
cannam@86:       }
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86: L119:
cannam@86:   for(ik=0;ik<idl1;ik++)c2[ik]=ch2[ik];
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=ipp2*idl1;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=t0;
cannam@86:     t2-=t0;
cannam@86:     t3=t1-ido;
cannam@86:     t4=t2-ido;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       t3+=ido;
cannam@86:       t4+=ido;
cannam@86:       c1[t3]=ch[t3]+ch[t4];
cannam@86:       c1[t4]=ch[t4]-ch[t3];
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86:   ar1=1.f;
cannam@86:   ai1=0.f;
cannam@86:   t1=0;
cannam@86:   t2=ipp2*idl1;
cannam@86:   t3=(ip-1)*idl1;
cannam@86:   for(l=1;l<ipph;l++){
cannam@86:     t1+=idl1;
cannam@86:     t2-=idl1;
cannam@86:     ar1h=dcp*ar1-dsp*ai1;
cannam@86:     ai1=dcp*ai1+dsp*ar1;
cannam@86:     ar1=ar1h;
cannam@86:     t4=t1;
cannam@86:     t5=t2;
cannam@86:     t6=t3;
cannam@86:     t7=idl1;
cannam@86: 
cannam@86:     for(ik=0;ik<idl1;ik++){
cannam@86:       ch2[t4++]=c2[ik]+ar1*c2[t7++];
cannam@86:       ch2[t5++]=ai1*c2[t6++];
cannam@86:     }
cannam@86: 
cannam@86:     dc2=ar1;
cannam@86:     ds2=ai1;
cannam@86:     ar2=ar1;
cannam@86:     ai2=ai1;
cannam@86: 
cannam@86:     t4=idl1;
cannam@86:     t5=(ipp2-1)*idl1;
cannam@86:     for(j=2;j<ipph;j++){
cannam@86:       t4+=idl1;
cannam@86:       t5-=idl1;
cannam@86: 
cannam@86:       ar2h=dc2*ar2-ds2*ai2;
cannam@86:       ai2=dc2*ai2+ds2*ar2;
cannam@86:       ar2=ar2h;
cannam@86: 
cannam@86:       t6=t1;
cannam@86:       t7=t2;
cannam@86:       t8=t4;
cannam@86:       t9=t5;
cannam@86:       for(ik=0;ik<idl1;ik++){
cannam@86:         ch2[t6++]+=ar2*c2[t8++];
cannam@86:         ch2[t7++]+=ai2*c2[t9++];
cannam@86:       }
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86:   t1=0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=idl1;
cannam@86:     t2=t1;
cannam@86:     for(ik=0;ik<idl1;ik++)ch2[ik]+=c2[t2++];
cannam@86:   }
cannam@86: 
cannam@86:   if(ido<l1)goto L132;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=0;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     t3=t1;
cannam@86:     t4=t2;
cannam@86:     for(i=0;i<ido;i++)cc[t4++]=ch[t3++];
cannam@86:     t1+=ido;
cannam@86:     t2+=t10;
cannam@86:   }
cannam@86: 
cannam@86:   goto L135;
cannam@86: 
cannam@86:  L132:
cannam@86:   for(i=0;i<ido;i++){
cannam@86:     t1=i;
cannam@86:     t2=i;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       cc[t2]=ch[t1];
cannam@86:       t1+=ido;
cannam@86:       t2+=t10;
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86:  L135:
cannam@86:   t1=0;
cannam@86:   t2=ido<<1;
cannam@86:   t3=0;
cannam@86:   t4=ipp2*t0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86: 
cannam@86:     t1+=t2;
cannam@86:     t3+=t0;
cannam@86:     t4-=t0;
cannam@86: 
cannam@86:     t5=t1;
cannam@86:     t6=t3;
cannam@86:     t7=t4;
cannam@86: 
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       cc[t5-1]=ch[t6];
cannam@86:       cc[t5]=ch[t7];
cannam@86:       t5+=t10;
cannam@86:       t6+=ido;
cannam@86:       t7+=ido;
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86:   if(ido==1)return;
cannam@86:   if(nbd<l1)goto L141;
cannam@86: 
cannam@86:   t1=-ido;
cannam@86:   t3=0;
cannam@86:   t4=0;
cannam@86:   t5=ipp2*t0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=t2;
cannam@86:     t3+=t2;
cannam@86:     t4+=t0;
cannam@86:     t5-=t0;
cannam@86:     t6=t1;
cannam@86:     t7=t3;
cannam@86:     t8=t4;
cannam@86:     t9=t5;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       for(i=2;i<ido;i+=2){
cannam@86:         ic=idp2-i;
cannam@86:         cc[i+t7-1]=ch[i+t8-1]+ch[i+t9-1];
cannam@86:         cc[ic+t6-1]=ch[i+t8-1]-ch[i+t9-1];
cannam@86:         cc[i+t7]=ch[i+t8]+ch[i+t9];
cannam@86:         cc[ic+t6]=ch[i+t9]-ch[i+t8];
cannam@86:       }
cannam@86:       t6+=t10;
cannam@86:       t7+=t10;
cannam@86:       t8+=ido;
cannam@86:       t9+=ido;
cannam@86:     }
cannam@86:   }
cannam@86:   return;
cannam@86: 
cannam@86:  L141:
cannam@86: 
cannam@86:   t1=-ido;
cannam@86:   t3=0;
cannam@86:   t4=0;
cannam@86:   t5=ipp2*t0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=t2;
cannam@86:     t3+=t2;
cannam@86:     t4+=t0;
cannam@86:     t5-=t0;
cannam@86:     for(i=2;i<ido;i+=2){
cannam@86:       t6=idp2+t1-i;
cannam@86:       t7=i+t3;
cannam@86:       t8=i+t4;
cannam@86:       t9=i+t5;
cannam@86:       for(k=0;k<l1;k++){
cannam@86:         cc[t7-1]=ch[t8-1]+ch[t9-1];
cannam@86:         cc[t6-1]=ch[t8-1]-ch[t9-1];
cannam@86:         cc[t7]=ch[t8]+ch[t9];
cannam@86:         cc[t6]=ch[t9]-ch[t8];
cannam@86:         t6+=t10;
cannam@86:         t7+=t10;
cannam@86:         t8+=ido;
cannam@86:         t9+=ido;
cannam@86:       }
cannam@86:     }
cannam@86:   }
cannam@86: }
cannam@86: 
cannam@86: static void drftf1(int n,float *c,float *ch,float *wa,int *ifac){
cannam@86:   int i,k1,l1,l2;
cannam@86:   int na,kh,nf;
cannam@86:   int ip,iw,ido,idl1,ix2,ix3;
cannam@86: 
cannam@86:   nf=ifac[1];
cannam@86:   na=1;
cannam@86:   l2=n;
cannam@86:   iw=n;
cannam@86: 
cannam@86:   for(k1=0;k1<nf;k1++){
cannam@86:     kh=nf-k1;
cannam@86:     ip=ifac[kh+1];
cannam@86:     l1=l2/ip;
cannam@86:     ido=n/l2;
cannam@86:     idl1=ido*l1;
cannam@86:     iw-=(ip-1)*ido;
cannam@86:     na=1-na;
cannam@86: 
cannam@86:     if(ip!=4)goto L102;
cannam@86: 
cannam@86:     ix2=iw+ido;
cannam@86:     ix3=ix2+ido;
cannam@86:     if(na!=0)
cannam@86:       dradf4(ido,l1,ch,c,wa+iw-1,wa+ix2-1,wa+ix3-1);
cannam@86:     else
cannam@86:       dradf4(ido,l1,c,ch,wa+iw-1,wa+ix2-1,wa+ix3-1);
cannam@86:     goto L110;
cannam@86: 
cannam@86:  L102:
cannam@86:     if(ip!=2)goto L104;
cannam@86:     if(na!=0)goto L103;
cannam@86: 
cannam@86:     dradf2(ido,l1,c,ch,wa+iw-1);
cannam@86:     goto L110;
cannam@86: 
cannam@86:   L103:
cannam@86:     dradf2(ido,l1,ch,c,wa+iw-1);
cannam@86:     goto L110;
cannam@86: 
cannam@86:   L104:
cannam@86:     if(ido==1)na=1-na;
cannam@86:     if(na!=0)goto L109;
cannam@86: 
cannam@86:     dradfg(ido,ip,l1,idl1,c,c,c,ch,ch,wa+iw-1);
cannam@86:     na=1;
cannam@86:     goto L110;
cannam@86: 
cannam@86:   L109:
cannam@86:     dradfg(ido,ip,l1,idl1,ch,ch,ch,c,c,wa+iw-1);
cannam@86:     na=0;
cannam@86: 
cannam@86:   L110:
cannam@86:     l2=l1;
cannam@86:   }
cannam@86: 
cannam@86:   if(na==1)return;
cannam@86: 
cannam@86:   for(i=0;i<n;i++)c[i]=ch[i];
cannam@86: }
cannam@86: 
cannam@86: static void dradb2(int ido,int l1,float *cc,float *ch,float *wa1){
cannam@86:   int i,k,t0,t1,t2,t3,t4,t5,t6;
cannam@86:   float ti2,tr2;
cannam@86: 
cannam@86:   t0=l1*ido;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=0;
cannam@86:   t3=(ido<<1)-1;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     ch[t1]=cc[t2]+cc[t3+t2];
cannam@86:     ch[t1+t0]=cc[t2]-cc[t3+t2];
cannam@86:     t2=(t1+=ido)<<1;
cannam@86:   }
cannam@86: 
cannam@86:   if(ido<2)return;
cannam@86:   if(ido==2)goto L105;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=0;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     t3=t1;
cannam@86:     t5=(t4=t2)+(ido<<1);
cannam@86:     t6=t0+t1;
cannam@86:     for(i=2;i<ido;i+=2){
cannam@86:       t3+=2;
cannam@86:       t4+=2;
cannam@86:       t5-=2;
cannam@86:       t6+=2;
cannam@86:       ch[t3-1]=cc[t4-1]+cc[t5-1];
cannam@86:       tr2=cc[t4-1]-cc[t5-1];
cannam@86:       ch[t3]=cc[t4]-cc[t5];
cannam@86:       ti2=cc[t4]+cc[t5];
cannam@86:       ch[t6-1]=wa1[i-2]*tr2-wa1[i-1]*ti2;
cannam@86:       ch[t6]=wa1[i-2]*ti2+wa1[i-1]*tr2;
cannam@86:     }
cannam@86:     t2=(t1+=ido)<<1;
cannam@86:   }
cannam@86: 
cannam@86:   if(ido%2==1)return;
cannam@86: 
cannam@86: L105:
cannam@86:   t1=ido-1;
cannam@86:   t2=ido-1;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     ch[t1]=cc[t2]+cc[t2];
cannam@86:     ch[t1+t0]=-(cc[t2+1]+cc[t2+1]);
cannam@86:     t1+=ido;
cannam@86:     t2+=ido<<1;
cannam@86:   }
cannam@86: }
cannam@86: 
cannam@86: static void dradb3(int ido,int l1,float *cc,float *ch,float *wa1,
cannam@86:                           float *wa2){
cannam@86:   static float taur = -.5f;
cannam@86:   static float taui = .8660254037844386f;
cannam@86:   int i,k,t0,t1,t2,t3,t4,t5,t6,t7,t8,t9,t10;
cannam@86:   float ci2,ci3,di2,di3,cr2,cr3,dr2,dr3,ti2,tr2;
cannam@86:   t0=l1*ido;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=t0<<1;
cannam@86:   t3=ido<<1;
cannam@86:   t4=ido+(ido<<1);
cannam@86:   t5=0;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     tr2=cc[t3-1]+cc[t3-1];
cannam@86:     cr2=cc[t5]+(taur*tr2);
cannam@86:     ch[t1]=cc[t5]+tr2;
cannam@86:     ci3=taui*(cc[t3]+cc[t3]);
cannam@86:     ch[t1+t0]=cr2-ci3;
cannam@86:     ch[t1+t2]=cr2+ci3;
cannam@86:     t1+=ido;
cannam@86:     t3+=t4;
cannam@86:     t5+=t4;
cannam@86:   }
cannam@86: 
cannam@86:   if(ido==1)return;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t3=ido<<1;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     t7=t1+(t1<<1);
cannam@86:     t6=(t5=t7+t3);
cannam@86:     t8=t1;
cannam@86:     t10=(t9=t1+t0)+t0;
cannam@86: 
cannam@86:     for(i=2;i<ido;i+=2){
cannam@86:       t5+=2;
cannam@86:       t6-=2;
cannam@86:       t7+=2;
cannam@86:       t8+=2;
cannam@86:       t9+=2;
cannam@86:       t10+=2;
cannam@86:       tr2=cc[t5-1]+cc[t6-1];
cannam@86:       cr2=cc[t7-1]+(taur*tr2);
cannam@86:       ch[t8-1]=cc[t7-1]+tr2;
cannam@86:       ti2=cc[t5]-cc[t6];
cannam@86:       ci2=cc[t7]+(taur*ti2);
cannam@86:       ch[t8]=cc[t7]+ti2;
cannam@86:       cr3=taui*(cc[t5-1]-cc[t6-1]);
cannam@86:       ci3=taui*(cc[t5]+cc[t6]);
cannam@86:       dr2=cr2-ci3;
cannam@86:       dr3=cr2+ci3;
cannam@86:       di2=ci2+cr3;
cannam@86:       di3=ci2-cr3;
cannam@86:       ch[t9-1]=wa1[i-2]*dr2-wa1[i-1]*di2;
cannam@86:       ch[t9]=wa1[i-2]*di2+wa1[i-1]*dr2;
cannam@86:       ch[t10-1]=wa2[i-2]*dr3-wa2[i-1]*di3;
cannam@86:       ch[t10]=wa2[i-2]*di3+wa2[i-1]*dr3;
cannam@86:     }
cannam@86:     t1+=ido;
cannam@86:   }
cannam@86: }
cannam@86: 
cannam@86: static void dradb4(int ido,int l1,float *cc,float *ch,float *wa1,
cannam@86:                           float *wa2,float *wa3){
cannam@86:   static float sqrt2=1.414213562373095f;
cannam@86:   int i,k,t0,t1,t2,t3,t4,t5,t6,t7,t8;
cannam@86:   float ci2,ci3,ci4,cr2,cr3,cr4,ti1,ti2,ti3,ti4,tr1,tr2,tr3,tr4;
cannam@86:   t0=l1*ido;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=ido<<2;
cannam@86:   t3=0;
cannam@86:   t6=ido<<1;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     t4=t3+t6;
cannam@86:     t5=t1;
cannam@86:     tr3=cc[t4-1]+cc[t4-1];
cannam@86:     tr4=cc[t4]+cc[t4];
cannam@86:     tr1=cc[t3]-cc[(t4+=t6)-1];
cannam@86:     tr2=cc[t3]+cc[t4-1];
cannam@86:     ch[t5]=tr2+tr3;
cannam@86:     ch[t5+=t0]=tr1-tr4;
cannam@86:     ch[t5+=t0]=tr2-tr3;
cannam@86:     ch[t5+=t0]=tr1+tr4;
cannam@86:     t1+=ido;
cannam@86:     t3+=t2;
cannam@86:   }
cannam@86: 
cannam@86:   if(ido<2)return;
cannam@86:   if(ido==2)goto L105;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     t5=(t4=(t3=(t2=t1<<2)+t6))+t6;
cannam@86:     t7=t1;
cannam@86:     for(i=2;i<ido;i+=2){
cannam@86:       t2+=2;
cannam@86:       t3+=2;
cannam@86:       t4-=2;
cannam@86:       t5-=2;
cannam@86:       t7+=2;
cannam@86:       ti1=cc[t2]+cc[t5];
cannam@86:       ti2=cc[t2]-cc[t5];
cannam@86:       ti3=cc[t3]-cc[t4];
cannam@86:       tr4=cc[t3]+cc[t4];
cannam@86:       tr1=cc[t2-1]-cc[t5-1];
cannam@86:       tr2=cc[t2-1]+cc[t5-1];
cannam@86:       ti4=cc[t3-1]-cc[t4-1];
cannam@86:       tr3=cc[t3-1]+cc[t4-1];
cannam@86:       ch[t7-1]=tr2+tr3;
cannam@86:       cr3=tr2-tr3;
cannam@86:       ch[t7]=ti2+ti3;
cannam@86:       ci3=ti2-ti3;
cannam@86:       cr2=tr1-tr4;
cannam@86:       cr4=tr1+tr4;
cannam@86:       ci2=ti1+ti4;
cannam@86:       ci4=ti1-ti4;
cannam@86: 
cannam@86:       ch[(t8=t7+t0)-1]=wa1[i-2]*cr2-wa1[i-1]*ci2;
cannam@86:       ch[t8]=wa1[i-2]*ci2+wa1[i-1]*cr2;
cannam@86:       ch[(t8+=t0)-1]=wa2[i-2]*cr3-wa2[i-1]*ci3;
cannam@86:       ch[t8]=wa2[i-2]*ci3+wa2[i-1]*cr3;
cannam@86:       ch[(t8+=t0)-1]=wa3[i-2]*cr4-wa3[i-1]*ci4;
cannam@86:       ch[t8]=wa3[i-2]*ci4+wa3[i-1]*cr4;
cannam@86:     }
cannam@86:     t1+=ido;
cannam@86:   }
cannam@86: 
cannam@86:   if(ido%2 == 1)return;
cannam@86: 
cannam@86:  L105:
cannam@86: 
cannam@86:   t1=ido;
cannam@86:   t2=ido<<2;
cannam@86:   t3=ido-1;
cannam@86:   t4=ido+(ido<<1);
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     t5=t3;
cannam@86:     ti1=cc[t1]+cc[t4];
cannam@86:     ti2=cc[t4]-cc[t1];
cannam@86:     tr1=cc[t1-1]-cc[t4-1];
cannam@86:     tr2=cc[t1-1]+cc[t4-1];
cannam@86:     ch[t5]=tr2+tr2;
cannam@86:     ch[t5+=t0]=sqrt2*(tr1-ti1);
cannam@86:     ch[t5+=t0]=ti2+ti2;
cannam@86:     ch[t5+=t0]=-sqrt2*(tr1+ti1);
cannam@86: 
cannam@86:     t3+=ido;
cannam@86:     t1+=t2;
cannam@86:     t4+=t2;
cannam@86:   }
cannam@86: }
cannam@86: 
cannam@86: static void dradbg(int ido,int ip,int l1,int idl1,float *cc,float *c1,
cannam@86:             float *c2,float *ch,float *ch2,float *wa){
cannam@86:   static float tpi=6.283185307179586f;
cannam@86:   int idij,ipph,i,j,k,l,ik,is,t0,t1,t2,t3,t4,t5,t6,t7,t8,t9,t10,
cannam@86:       t11,t12;
cannam@86:   float dc2,ai1,ai2,ar1,ar2,ds2;
cannam@86:   int nbd;
cannam@86:   float dcp,arg,dsp,ar1h,ar2h;
cannam@86:   int ipp2;
cannam@86: 
cannam@86:   t10=ip*ido;
cannam@86:   t0=l1*ido;
cannam@86:   arg=tpi/(float)ip;
cannam@86:   dcp=cos(arg);
cannam@86:   dsp=sin(arg);
cannam@86:   nbd=(ido-1)>>1;
cannam@86:   ipp2=ip;
cannam@86:   ipph=(ip+1)>>1;
cannam@86:   if(ido<l1)goto L103;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=0;
cannam@86:   for(k=0;k<l1;k++){
cannam@86:     t3=t1;
cannam@86:     t4=t2;
cannam@86:     for(i=0;i<ido;i++){
cannam@86:       ch[t3]=cc[t4];
cannam@86:       t3++;
cannam@86:       t4++;
cannam@86:     }
cannam@86:     t1+=ido;
cannam@86:     t2+=t10;
cannam@86:   }
cannam@86:   goto L106;
cannam@86: 
cannam@86:  L103:
cannam@86:   t1=0;
cannam@86:   for(i=0;i<ido;i++){
cannam@86:     t2=t1;
cannam@86:     t3=t1;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       ch[t2]=cc[t3];
cannam@86:       t2+=ido;
cannam@86:       t3+=t10;
cannam@86:     }
cannam@86:     t1++;
cannam@86:   }
cannam@86: 
cannam@86:  L106:
cannam@86:   t1=0;
cannam@86:   t2=ipp2*t0;
cannam@86:   t7=(t5=ido<<1);
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=t0;
cannam@86:     t2-=t0;
cannam@86:     t3=t1;
cannam@86:     t4=t2;
cannam@86:     t6=t5;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       ch[t3]=cc[t6-1]+cc[t6-1];
cannam@86:       ch[t4]=cc[t6]+cc[t6];
cannam@86:       t3+=ido;
cannam@86:       t4+=ido;
cannam@86:       t6+=t10;
cannam@86:     }
cannam@86:     t5+=t7;
cannam@86:   }
cannam@86: 
cannam@86:   if (ido == 1)goto L116;
cannam@86:   if(nbd<l1)goto L112;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=ipp2*t0;
cannam@86:   t7=0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=t0;
cannam@86:     t2-=t0;
cannam@86:     t3=t1;
cannam@86:     t4=t2;
cannam@86: 
cannam@86:     t7+=(ido<<1);
cannam@86:     t8=t7;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       t5=t3;
cannam@86:       t6=t4;
cannam@86:       t9=t8;
cannam@86:       t11=t8;
cannam@86:       for(i=2;i<ido;i+=2){
cannam@86:         t5+=2;
cannam@86:         t6+=2;
cannam@86:         t9+=2;
cannam@86:         t11-=2;
cannam@86:         ch[t5-1]=cc[t9-1]+cc[t11-1];
cannam@86:         ch[t6-1]=cc[t9-1]-cc[t11-1];
cannam@86:         ch[t5]=cc[t9]-cc[t11];
cannam@86:         ch[t6]=cc[t9]+cc[t11];
cannam@86:       }
cannam@86:       t3+=ido;
cannam@86:       t4+=ido;
cannam@86:       t8+=t10;
cannam@86:     }
cannam@86:   }
cannam@86:   goto L116;
cannam@86: 
cannam@86:  L112:
cannam@86:   t1=0;
cannam@86:   t2=ipp2*t0;
cannam@86:   t7=0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=t0;
cannam@86:     t2-=t0;
cannam@86:     t3=t1;
cannam@86:     t4=t2;
cannam@86:     t7+=(ido<<1);
cannam@86:     t8=t7;
cannam@86:     t9=t7;
cannam@86:     for(i=2;i<ido;i+=2){
cannam@86:       t3+=2;
cannam@86:       t4+=2;
cannam@86:       t8+=2;
cannam@86:       t9-=2;
cannam@86:       t5=t3;
cannam@86:       t6=t4;
cannam@86:       t11=t8;
cannam@86:       t12=t9;
cannam@86:       for(k=0;k<l1;k++){
cannam@86:         ch[t5-1]=cc[t11-1]+cc[t12-1];
cannam@86:         ch[t6-1]=cc[t11-1]-cc[t12-1];
cannam@86:         ch[t5]=cc[t11]-cc[t12];
cannam@86:         ch[t6]=cc[t11]+cc[t12];
cannam@86:         t5+=ido;
cannam@86:         t6+=ido;
cannam@86:         t11+=t10;
cannam@86:         t12+=t10;
cannam@86:       }
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86: L116:
cannam@86:   ar1=1.f;
cannam@86:   ai1=0.f;
cannam@86:   t1=0;
cannam@86:   t9=(t2=ipp2*idl1);
cannam@86:   t3=(ip-1)*idl1;
cannam@86:   for(l=1;l<ipph;l++){
cannam@86:     t1+=idl1;
cannam@86:     t2-=idl1;
cannam@86: 
cannam@86:     ar1h=dcp*ar1-dsp*ai1;
cannam@86:     ai1=dcp*ai1+dsp*ar1;
cannam@86:     ar1=ar1h;
cannam@86:     t4=t1;
cannam@86:     t5=t2;
cannam@86:     t6=0;
cannam@86:     t7=idl1;
cannam@86:     t8=t3;
cannam@86:     for(ik=0;ik<idl1;ik++){
cannam@86:       c2[t4++]=ch2[t6++]+ar1*ch2[t7++];
cannam@86:       c2[t5++]=ai1*ch2[t8++];
cannam@86:     }
cannam@86:     dc2=ar1;
cannam@86:     ds2=ai1;
cannam@86:     ar2=ar1;
cannam@86:     ai2=ai1;
cannam@86: 
cannam@86:     t6=idl1;
cannam@86:     t7=t9-idl1;
cannam@86:     for(j=2;j<ipph;j++){
cannam@86:       t6+=idl1;
cannam@86:       t7-=idl1;
cannam@86:       ar2h=dc2*ar2-ds2*ai2;
cannam@86:       ai2=dc2*ai2+ds2*ar2;
cannam@86:       ar2=ar2h;
cannam@86:       t4=t1;
cannam@86:       t5=t2;
cannam@86:       t11=t6;
cannam@86:       t12=t7;
cannam@86:       for(ik=0;ik<idl1;ik++){
cannam@86:         c2[t4++]+=ar2*ch2[t11++];
cannam@86:         c2[t5++]+=ai2*ch2[t12++];
cannam@86:       }
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86:   t1=0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=idl1;
cannam@86:     t2=t1;
cannam@86:     for(ik=0;ik<idl1;ik++)ch2[ik]+=ch2[t2++];
cannam@86:   }
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=ipp2*t0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=t0;
cannam@86:     t2-=t0;
cannam@86:     t3=t1;
cannam@86:     t4=t2;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       ch[t3]=c1[t3]-c1[t4];
cannam@86:       ch[t4]=c1[t3]+c1[t4];
cannam@86:       t3+=ido;
cannam@86:       t4+=ido;
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86:   if(ido==1)goto L132;
cannam@86:   if(nbd<l1)goto L128;
cannam@86: 
cannam@86:   t1=0;
cannam@86:   t2=ipp2*t0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=t0;
cannam@86:     t2-=t0;
cannam@86:     t3=t1;
cannam@86:     t4=t2;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       t5=t3;
cannam@86:       t6=t4;
cannam@86:       for(i=2;i<ido;i+=2){
cannam@86:         t5+=2;
cannam@86:         t6+=2;
cannam@86:         ch[t5-1]=c1[t5-1]-c1[t6];
cannam@86:         ch[t6-1]=c1[t5-1]+c1[t6];
cannam@86:         ch[t5]=c1[t5]+c1[t6-1];
cannam@86:         ch[t6]=c1[t5]-c1[t6-1];
cannam@86:       }
cannam@86:       t3+=ido;
cannam@86:       t4+=ido;
cannam@86:     }
cannam@86:   }
cannam@86:   goto L132;
cannam@86: 
cannam@86:  L128:
cannam@86:   t1=0;
cannam@86:   t2=ipp2*t0;
cannam@86:   for(j=1;j<ipph;j++){
cannam@86:     t1+=t0;
cannam@86:     t2-=t0;
cannam@86:     t3=t1;
cannam@86:     t4=t2;
cannam@86:     for(i=2;i<ido;i+=2){
cannam@86:       t3+=2;
cannam@86:       t4+=2;
cannam@86:       t5=t3;
cannam@86:       t6=t4;
cannam@86:       for(k=0;k<l1;k++){
cannam@86:         ch[t5-1]=c1[t5-1]-c1[t6];
cannam@86:         ch[t6-1]=c1[t5-1]+c1[t6];
cannam@86:         ch[t5]=c1[t5]+c1[t6-1];
cannam@86:         ch[t6]=c1[t5]-c1[t6-1];
cannam@86:         t5+=ido;
cannam@86:         t6+=ido;
cannam@86:       }
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86: L132:
cannam@86:   if(ido==1)return;
cannam@86: 
cannam@86:   for(ik=0;ik<idl1;ik++)c2[ik]=ch2[ik];
cannam@86: 
cannam@86:   t1=0;
cannam@86:   for(j=1;j<ip;j++){
cannam@86:     t2=(t1+=t0);
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       c1[t2]=ch[t2];
cannam@86:       t2+=ido;
cannam@86:     }
cannam@86:   }
cannam@86: 
cannam@86:   if(nbd>l1)goto L139;
cannam@86: 
cannam@86:   is= -ido-1;
cannam@86:   t1=0;
cannam@86:   for(j=1;j<ip;j++){
cannam@86:     is+=ido;
cannam@86:     t1+=t0;
cannam@86:     idij=is;
cannam@86:     t2=t1;
cannam@86:     for(i=2;i<ido;i+=2){
cannam@86:       t2+=2;
cannam@86:       idij+=2;
cannam@86:       t3=t2;
cannam@86:       for(k=0;k<l1;k++){
cannam@86:         c1[t3-1]=wa[idij-1]*ch[t3-1]-wa[idij]*ch[t3];
cannam@86:         c1[t3]=wa[idij-1]*ch[t3]+wa[idij]*ch[t3-1];
cannam@86:         t3+=ido;
cannam@86:       }
cannam@86:     }
cannam@86:   }
cannam@86:   return;
cannam@86: 
cannam@86:  L139:
cannam@86:   is= -ido-1;
cannam@86:   t1=0;
cannam@86:   for(j=1;j<ip;j++){
cannam@86:     is+=ido;
cannam@86:     t1+=t0;
cannam@86:     t2=t1;
cannam@86:     for(k=0;k<l1;k++){
cannam@86:       idij=is;
cannam@86:       t3=t2;
cannam@86:       for(i=2;i<ido;i+=2){
cannam@86:         idij+=2;
cannam@86:         t3+=2;
cannam@86:         c1[t3-1]=wa[idij-1]*ch[t3-1]-wa[idij]*ch[t3];
cannam@86:         c1[t3]=wa[idij-1]*ch[t3]+wa[idij]*ch[t3-1];
cannam@86:       }
cannam@86:       t2+=ido;
cannam@86:     }
cannam@86:   }
cannam@86: }
cannam@86: 
cannam@86: static void drftb1(int n, float *c, float *ch, float *wa, int *ifac){
cannam@86:   int i,k1,l1,l2;
cannam@86:   int na;
cannam@86:   int nf,ip,iw,ix2,ix3,ido,idl1;
cannam@86: 
cannam@86:   nf=ifac[1];
cannam@86:   na=0;
cannam@86:   l1=1;
cannam@86:   iw=1;
cannam@86: 
cannam@86:   for(k1=0;k1<nf;k1++){
cannam@86:     ip=ifac[k1 + 2];
cannam@86:     l2=ip*l1;
cannam@86:     ido=n/l2;
cannam@86:     idl1=ido*l1;
cannam@86:     if(ip!=4)goto L103;
cannam@86:     ix2=iw+ido;
cannam@86:     ix3=ix2+ido;
cannam@86: 
cannam@86:     if(na!=0)
cannam@86:       dradb4(ido,l1,ch,c,wa+iw-1,wa+ix2-1,wa+ix3-1);
cannam@86:     else
cannam@86:       dradb4(ido,l1,c,ch,wa+iw-1,wa+ix2-1,wa+ix3-1);
cannam@86:     na=1-na;
cannam@86:     goto L115;
cannam@86: 
cannam@86:   L103:
cannam@86:     if(ip!=2)goto L106;
cannam@86: 
cannam@86:     if(na!=0)
cannam@86:       dradb2(ido,l1,ch,c,wa+iw-1);
cannam@86:     else
cannam@86:       dradb2(ido,l1,c,ch,wa+iw-1);
cannam@86:     na=1-na;
cannam@86:     goto L115;
cannam@86: 
cannam@86:   L106:
cannam@86:     if(ip!=3)goto L109;
cannam@86: 
cannam@86:     ix2=iw+ido;
cannam@86:     if(na!=0)
cannam@86:       dradb3(ido,l1,ch,c,wa+iw-1,wa+ix2-1);
cannam@86:     else
cannam@86:       dradb3(ido,l1,c,ch,wa+iw-1,wa+ix2-1);
cannam@86:     na=1-na;
cannam@86:     goto L115;
cannam@86: 
cannam@86:   L109:
cannam@86: /*    The radix five case can be translated later..... */
cannam@86: /*    if(ip!=5)goto L112;
cannam@86: 
cannam@86:     ix2=iw+ido;
cannam@86:     ix3=ix2+ido;
cannam@86:     ix4=ix3+ido;
cannam@86:     if(na!=0)
cannam@86:       dradb5(ido,l1,ch,c,wa+iw-1,wa+ix2-1,wa+ix3-1,wa+ix4-1);
cannam@86:     else
cannam@86:       dradb5(ido,l1,c,ch,wa+iw-1,wa+ix2-1,wa+ix3-1,wa+ix4-1);
cannam@86:     na=1-na;
cannam@86:     goto L115;
cannam@86: 
cannam@86:   L112:*/
cannam@86:     if(na!=0)
cannam@86:       dradbg(ido,ip,l1,idl1,ch,ch,ch,c,c,wa+iw-1);
cannam@86:     else
cannam@86:       dradbg(ido,ip,l1,idl1,c,c,c,ch,ch,wa+iw-1);
cannam@86:     if(ido==1)na=1-na;
cannam@86: 
cannam@86:   L115:
cannam@86:     l1=l2;
cannam@86:     iw+=(ip-1)*ido;
cannam@86:   }
cannam@86: 
cannam@86:   if(na==0)return;
cannam@86: 
cannam@86:   for(i=0;i<n;i++)c[i]=ch[i];
cannam@86: }
cannam@86: 
cannam@86: void drft_forward(drft_lookup *l,float *data){
cannam@86:   if(l->n==1)return;
cannam@86:   drftf1(l->n,data,l->trigcache,l->trigcache+l->n,l->splitcache);
cannam@86: }
cannam@86: 
cannam@86: void drft_backward(drft_lookup *l,float *data){
cannam@86:   if (l->n==1)return;
cannam@86:   drftb1(l->n,data,l->trigcache,l->trigcache+l->n,l->splitcache);
cannam@86: }
cannam@86: 
cannam@86: void drft_init(drft_lookup *l,int n){
cannam@86:   l->n=n;
cannam@86:   l->trigcache=_ogg_calloc(3*n,sizeof(*l->trigcache));
cannam@86:   l->splitcache=_ogg_calloc(32,sizeof(*l->splitcache));
cannam@86:   fdrffti(n, l->trigcache, l->splitcache);
cannam@86: }
cannam@86: 
cannam@86: void drft_clear(drft_lookup *l){
cannam@86:   if(l){
cannam@86:     if(l->trigcache)_ogg_free(l->trigcache);
cannam@86:     if(l->splitcache)_ogg_free(l->splitcache);
cannam@86:     memset(l,0,sizeof(*l));
cannam@86:   }
cannam@86: }