Blame fft/c_main.c

Packit 67cb25
/* fft/c_main.c
Packit 67cb25
 * 
Packit 67cb25
 * Copyright (C) 1996, 1997, 1998, 1999, 2000, 2007 Brian Gough
Packit 67cb25
 * 
Packit 67cb25
 * This program is free software; you can redistribute it and/or modify
Packit 67cb25
 * it under the terms of the GNU General Public License as published by
Packit 67cb25
 * the Free Software Foundation; either version 3 of the License, or (at
Packit 67cb25
 * your option) any later version.
Packit 67cb25
 * 
Packit 67cb25
 * This program is distributed in the hope that it will be useful, but
Packit 67cb25
 * WITHOUT ANY WARRANTY; without even the implied warranty of
Packit 67cb25
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
Packit 67cb25
 * General Public License for more details.
Packit 67cb25
 * 
Packit 67cb25
 * You should have received a copy of the GNU General Public License
Packit 67cb25
 * along with this program; if not, write to the Free Software
Packit 67cb25
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
Packit 67cb25
 */
Packit 67cb25
Packit 67cb25
#include "c_pass.h"
Packit 67cb25
Packit 67cb25
int
Packit 67cb25
FUNCTION(gsl_fft_complex,forward) (TYPE(gsl_complex_packed_array) data, 
Packit 67cb25
                                   const size_t stride, 
Packit 67cb25
                                   const size_t n,
Packit 67cb25
                                   const TYPE(gsl_fft_complex_wavetable) * wavetable,
Packit 67cb25
                                   TYPE(gsl_fft_complex_workspace) * work)
Packit 67cb25
{
Packit 67cb25
  gsl_fft_direction sign = gsl_fft_forward;
Packit 67cb25
  int status = FUNCTION(gsl_fft_complex,transform) (data, stride, n, 
Packit 67cb25
                                                    wavetable, work, sign);
Packit 67cb25
  return status;
Packit 67cb25
}
Packit 67cb25
Packit 67cb25
int
Packit 67cb25
FUNCTION(gsl_fft_complex,backward) (TYPE(gsl_complex_packed_array) data,
Packit 67cb25
                                    const size_t stride, 
Packit 67cb25
                                    const size_t n,
Packit 67cb25
                                    const TYPE(gsl_fft_complex_wavetable) * wavetable,
Packit 67cb25
                                    TYPE(gsl_fft_complex_workspace) * work)
Packit 67cb25
{
Packit 67cb25
  gsl_fft_direction sign = gsl_fft_backward;
Packit 67cb25
  int status = FUNCTION(gsl_fft_complex,transform) (data, stride, n, 
Packit 67cb25
                                                    wavetable, work, sign);
Packit 67cb25
  return status;
Packit 67cb25
}
Packit 67cb25
Packit 67cb25
int
Packit 67cb25
FUNCTION(gsl_fft_complex,inverse) (TYPE(gsl_complex_packed_array) data, 
Packit 67cb25
                                   const size_t stride, 
Packit 67cb25
                                   const size_t n,
Packit 67cb25
                                   const TYPE(gsl_fft_complex_wavetable) * wavetable,
Packit 67cb25
                                   TYPE(gsl_fft_complex_workspace) * work)
Packit 67cb25
{
Packit 67cb25
  gsl_fft_direction sign = gsl_fft_backward;
Packit 67cb25
  int status = FUNCTION(gsl_fft_complex,transform) (data, stride, n, 
Packit 67cb25
                                                    wavetable, work, sign);
Packit 67cb25
Packit 67cb25
  if (status)
Packit 67cb25
    {
Packit 67cb25
      return status;
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  /* normalize inverse fft with 1/n */
Packit 67cb25
Packit 67cb25
  {
Packit 67cb25
    const ATOMIC norm = ONE / (ATOMIC)n;
Packit 67cb25
    size_t i;
Packit 67cb25
    for (i = 0; i < n; i++)
Packit 67cb25
      {
Packit 67cb25
        REAL(data,stride,i) *= norm;
Packit 67cb25
        IMAG(data,stride,i) *= norm;
Packit 67cb25
      }
Packit 67cb25
  }
Packit 67cb25
  return status;
Packit 67cb25
}
Packit 67cb25
Packit 67cb25
int
Packit 67cb25
FUNCTION(gsl_fft_complex,transform) (TYPE(gsl_complex_packed_array) data, 
Packit 67cb25
                                     const size_t stride, 
Packit 67cb25
                                     const size_t n,
Packit 67cb25
                                     const TYPE(gsl_fft_complex_wavetable) * wavetable,
Packit 67cb25
                                     TYPE(gsl_fft_complex_workspace) * work,
Packit 67cb25
                                     const gsl_fft_direction sign)
Packit 67cb25
{
Packit 67cb25
  const size_t nf = wavetable->nf;
Packit 67cb25
Packit 67cb25
  size_t i;
Packit 67cb25
Packit 67cb25
  size_t q, product = 1;
Packit 67cb25
Packit 67cb25
  TYPE(gsl_complex) *twiddle1, *twiddle2, *twiddle3, *twiddle4,
Packit 67cb25
    *twiddle5, *twiddle6;
Packit 67cb25
Packit 67cb25
  size_t state = 0;
Packit 67cb25
Packit 67cb25
  BASE * const scratch = work->scratch;
Packit 67cb25
Packit 67cb25
  BASE * in = data;
Packit 67cb25
  size_t istride = stride;
Packit 67cb25
Packit 67cb25
  BASE * out = scratch;
Packit 67cb25
  size_t ostride = 1;
Packit 67cb25
Packit 67cb25
  if (n == 0)
Packit 67cb25
    {
Packit 67cb25
      GSL_ERROR ("length n must be positive integer", GSL_EDOM);
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  if (n == 1)
Packit 67cb25
    {                           /* FFT of 1 data point is the identity */
Packit 67cb25
      return 0;
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  if (n != wavetable->n)
Packit 67cb25
    {
Packit 67cb25
      GSL_ERROR ("wavetable does not match length of data", GSL_EINVAL);
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  if (n != work->n)
Packit 67cb25
    {
Packit 67cb25
      GSL_ERROR ("workspace does not match length of data", GSL_EINVAL);
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  for (i = 0; i < nf; i++)
Packit 67cb25
    {
Packit 67cb25
      const size_t factor = wavetable->factor[i];
Packit 67cb25
      product *= factor;
Packit 67cb25
      q = n / product;
Packit 67cb25
Packit 67cb25
      if (state == 0)
Packit 67cb25
        {
Packit 67cb25
          in = data;
Packit 67cb25
          istride = stride;
Packit 67cb25
          out = scratch;
Packit 67cb25
          ostride = 1;
Packit 67cb25
          state = 1;
Packit 67cb25
        }
Packit 67cb25
      else
Packit 67cb25
        {
Packit 67cb25
          in = scratch;
Packit 67cb25
          istride = 1;
Packit 67cb25
          out = data;
Packit 67cb25
          ostride = stride;
Packit 67cb25
          state = 0;
Packit 67cb25
        }
Packit 67cb25
Packit 67cb25
      if (factor == 2)
Packit 67cb25
        {
Packit 67cb25
          twiddle1 = wavetable->twiddle[i];
Packit 67cb25
          FUNCTION(fft_complex,pass_2) (in, istride, out, ostride, sign, 
Packit 67cb25
                                        product, n, twiddle1);
Packit 67cb25
        }
Packit 67cb25
      else if (factor == 3)
Packit 67cb25
        {
Packit 67cb25
          twiddle1 = wavetable->twiddle[i];
Packit 67cb25
          twiddle2 = twiddle1 + q;
Packit 67cb25
          FUNCTION(fft_complex,pass_3) (in, istride, out, ostride, sign, 
Packit 67cb25
                                        product, n, twiddle1, twiddle2);
Packit 67cb25
        }
Packit 67cb25
      else if (factor == 4)
Packit 67cb25
        {
Packit 67cb25
          twiddle1 = wavetable->twiddle[i];
Packit 67cb25
          twiddle2 = twiddle1 + q;
Packit 67cb25
          twiddle3 = twiddle2 + q;
Packit 67cb25
          FUNCTION(fft_complex,pass_4) (in, istride, out, ostride, sign, 
Packit 67cb25
                                        product, n, twiddle1, twiddle2, 
Packit 67cb25
                                        twiddle3);
Packit 67cb25
        }
Packit 67cb25
      else if (factor == 5)
Packit 67cb25
        {
Packit 67cb25
          twiddle1 = wavetable->twiddle[i];
Packit 67cb25
          twiddle2 = twiddle1 + q;
Packit 67cb25
          twiddle3 = twiddle2 + q;
Packit 67cb25
          twiddle4 = twiddle3 + q;
Packit 67cb25
          FUNCTION(fft_complex,pass_5) (in, istride, out, ostride, sign, 
Packit 67cb25
                                        product, n, twiddle1, twiddle2, 
Packit 67cb25
                                        twiddle3, twiddle4);
Packit 67cb25
        }
Packit 67cb25
      else if (factor == 6)
Packit 67cb25
        {
Packit 67cb25
          twiddle1 = wavetable->twiddle[i];
Packit 67cb25
          twiddle2 = twiddle1 + q;
Packit 67cb25
          twiddle3 = twiddle2 + q;
Packit 67cb25
          twiddle4 = twiddle3 + q;
Packit 67cb25
          twiddle5 = twiddle4 + q;
Packit 67cb25
          FUNCTION(fft_complex,pass_6) (in, istride, out, ostride, sign, 
Packit 67cb25
                                        product, n, twiddle1, twiddle2, 
Packit 67cb25
                                        twiddle3, twiddle4, twiddle5);
Packit 67cb25
        }
Packit 67cb25
      else if (factor == 7)
Packit 67cb25
        {
Packit 67cb25
          twiddle1 = wavetable->twiddle[i];
Packit 67cb25
          twiddle2 = twiddle1 + q;
Packit 67cb25
          twiddle3 = twiddle2 + q;
Packit 67cb25
          twiddle4 = twiddle3 + q;
Packit 67cb25
          twiddle5 = twiddle4 + q;
Packit 67cb25
          twiddle6 = twiddle5 + q;
Packit 67cb25
          FUNCTION(fft_complex,pass_7) (in, istride, out, ostride, sign, 
Packit 67cb25
                                        product, n, twiddle1, twiddle2, 
Packit 67cb25
                                        twiddle3, twiddle4, twiddle5, 
Packit 67cb25
                                        twiddle6);
Packit 67cb25
        }
Packit 67cb25
      else
Packit 67cb25
        {
Packit 67cb25
          twiddle1 = wavetable->twiddle[i];
Packit 67cb25
          FUNCTION(fft_complex,pass_n) (in, istride, out, ostride, sign, 
Packit 67cb25
                                        factor, product, n, twiddle1);
Packit 67cb25
        }
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  if (state == 1)               /* copy results back from scratch to data */
Packit 67cb25
    {
Packit 67cb25
      for (i = 0; i < n; i++)
Packit 67cb25
        {
Packit 67cb25
          REAL(data,stride,i) = REAL(scratch,1,i) ;
Packit 67cb25
          IMAG(data,stride,i) = IMAG(scratch,1,i) ;
Packit 67cb25
        }
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  return 0;
Packit 67cb25
Packit 67cb25
}