Blame fft/c_pass_n.c

Packit 67cb25
/* fft/c_pass_n.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
static int
Packit 67cb25
FUNCTION(fft_complex,pass_n) (BASE in[],
Packit 67cb25
                              const size_t istride,
Packit 67cb25
                              BASE out[],
Packit 67cb25
                              const size_t ostride,
Packit 67cb25
                              const gsl_fft_direction sign,
Packit 67cb25
                              const size_t factor,
Packit 67cb25
                              const size_t product,
Packit 67cb25
                              const size_t n,
Packit 67cb25
                              const TYPE(gsl_complex) twiddle[])
Packit 67cb25
{
Packit 67cb25
  size_t i = 0, j = 0;
Packit 67cb25
  size_t k, k1;
Packit 67cb25
Packit 67cb25
  const size_t m = n / factor;
Packit 67cb25
  const size_t q = n / product;
Packit 67cb25
  const size_t p_1 = product / factor;
Packit 67cb25
  const size_t jump = (factor - 1) * p_1;
Packit 67cb25
Packit 67cb25
  size_t e, e1;
Packit 67cb25
Packit 67cb25
  for (i = 0; i < m; i++)
Packit 67cb25
    {
Packit 67cb25
      REAL(out,ostride,i) = REAL(in,istride,i);
Packit 67cb25
      IMAG(out,ostride,i) = IMAG(in,istride,i);
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  for (e = 1; e < (factor - 1) / 2 + 1; e++)
Packit 67cb25
    {
Packit 67cb25
      for (i = 0; i < m; i++)
Packit 67cb25
        {
Packit 67cb25
          const size_t idx = i + e * m;
Packit 67cb25
          const size_t idxc = i + (factor - e) * m;
Packit 67cb25
          REAL(out,ostride,idx) = REAL(in,istride,idx) + REAL(in,istride,idxc);
Packit 67cb25
          IMAG(out,ostride,idx) = IMAG(in,istride,idx) + IMAG(in,istride,idxc);
Packit 67cb25
          REAL(out,ostride,idxc) = REAL(in,istride,idx) - REAL(in,istride,idxc);
Packit 67cb25
          IMAG(out,ostride,idxc) = IMAG(in,istride,idx) - IMAG(in,istride,idxc);
Packit 67cb25
        }
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  /* e = 0 */
Packit 67cb25
Packit 67cb25
  for (i=0 ; i
Packit 67cb25
    {
Packit 67cb25
      REAL(in,istride,i) = REAL(out,ostride,i);
Packit 67cb25
      IMAG(in,istride,i) = IMAG(out,ostride,i);
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  for (e1 = 1; e1 < (factor - 1) / 2 + 1; e1++)
Packit 67cb25
    {
Packit 67cb25
      for (i = 0; i < m; i++)
Packit 67cb25
        {
Packit 67cb25
          REAL(in,istride,i) += REAL(out,ostride,i + e1*m) ;
Packit 67cb25
          IMAG(in,istride,i) += IMAG(out,ostride,i + e1*m) ;
Packit 67cb25
        }
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  for (e = 1; e < (factor-1)/2 + 1; e++)
Packit 67cb25
    {
Packit 67cb25
      size_t idx = e*q ;
Packit 67cb25
      const size_t idx_step = e * q ;
Packit 67cb25
      ATOMIC w_real, w_imag ;
Packit 67cb25
Packit 67cb25
      const size_t em = e * m ;
Packit 67cb25
      const size_t ecm = (factor - e) * m ;
Packit 67cb25
Packit 67cb25
      for (i = 0; i < m; i++) 
Packit 67cb25
        {
Packit 67cb25
          REAL(in,istride,i+em) = REAL(out,ostride,i) ;
Packit 67cb25
          IMAG(in,istride,i+em) = IMAG(out,ostride,i) ;
Packit 67cb25
          REAL(in,istride,i+ecm) = REAL(out,ostride,i) ;
Packit 67cb25
          IMAG(in,istride,i+ecm) = IMAG(out,ostride,i) ;
Packit 67cb25
        }
Packit 67cb25
Packit 67cb25
      for (e1 = 1; e1 < (factor - 1) / 2 + 1; e1++)
Packit 67cb25
        {
Packit 67cb25
          if (idx == 0) {
Packit 67cb25
            w_real = 1 ;
Packit 67cb25
            w_imag = 0 ;
Packit 67cb25
          } else {
Packit 67cb25
            if (sign == gsl_fft_forward) {
Packit 67cb25
              w_real = GSL_REAL(twiddle[idx - 1]) ;
Packit 67cb25
              w_imag = GSL_IMAG(twiddle[idx - 1]) ;
Packit 67cb25
            } else {
Packit 67cb25
              w_real = GSL_REAL(twiddle[idx - 1]) ;
Packit 67cb25
              w_imag = -GSL_IMAG(twiddle[idx - 1]) ;
Packit 67cb25
            }
Packit 67cb25
          }
Packit 67cb25
Packit 67cb25
          for (i = 0; i < m; i++) 
Packit 67cb25
            {
Packit 67cb25
              const ATOMIC xp_real = REAL(out,ostride,i + e1 * m);
Packit 67cb25
              const ATOMIC xp_imag = IMAG(out,ostride,i + e1 * m);
Packit 67cb25
              const ATOMIC xm_real = REAL(out,ostride,i + (factor - e1) *m);
Packit 67cb25
              const ATOMIC xm_imag = IMAG(out,ostride,i + (factor - e1) *m);
Packit 67cb25
        
Packit 67cb25
              const ATOMIC ap = w_real * xp_real ;
Packit 67cb25
              const ATOMIC am = w_imag * xm_imag ; 
Packit 67cb25
Packit 67cb25
              ATOMIC sum_real = ap - am;
Packit 67cb25
              ATOMIC sumc_real = ap + am;
Packit 67cb25
Packit 67cb25
              const ATOMIC bp = w_real * xp_imag ;
Packit 67cb25
              const ATOMIC bm = w_imag * xm_real ;
Packit 67cb25
Packit 67cb25
              ATOMIC sum_imag = bp + bm;
Packit 67cb25
              ATOMIC sumc_imag = bp - bm;
Packit 67cb25
Packit 67cb25
              REAL(in,istride,i + em) += sum_real;
Packit 67cb25
              IMAG(in,istride,i + em) += sum_imag;
Packit 67cb25
              REAL(in,istride,i + ecm) += sumc_real;
Packit 67cb25
              IMAG(in,istride,i + ecm) += sumc_imag;
Packit 67cb25
            }
Packit 67cb25
          idx += idx_step ;
Packit 67cb25
          idx %= factor * q ;
Packit 67cb25
        }
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  i = 0;
Packit 67cb25
  j = 0;
Packit 67cb25
Packit 67cb25
  /* k = 0 */
Packit 67cb25
  for (k1 = 0; k1 < p_1; k1++)
Packit 67cb25
    {
Packit 67cb25
      REAL(out,ostride,k1) = REAL(in,istride,k1);
Packit 67cb25
      IMAG(out,ostride,k1) = IMAG(in,istride,k1);
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  for (e1 = 1; e1 < factor; e1++)
Packit 67cb25
    {
Packit 67cb25
      for (k1 = 0; k1 < p_1; k1++)
Packit 67cb25
        {
Packit 67cb25
          REAL(out,ostride,k1 + e1 * p_1) = REAL(in,istride,k1 + e1 * m) ;
Packit 67cb25
          IMAG(out,ostride,k1 + e1 * p_1) = IMAG(in,istride,k1 + e1 * m) ;
Packit 67cb25
        }
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  i = p_1 ;
Packit 67cb25
  j = product ;
Packit 67cb25
Packit 67cb25
  for (k = 1; k < q; k++)
Packit 67cb25
    {
Packit 67cb25
      for (k1 = 0; k1 < p_1; k1++)
Packit 67cb25
        {
Packit 67cb25
          REAL(out,ostride,j) = REAL(in,istride,i);
Packit 67cb25
          IMAG(out,ostride,j) = IMAG(in,istride,i);
Packit 67cb25
          i++;
Packit 67cb25
          j++;
Packit 67cb25
        }
Packit 67cb25
      j += jump;
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  i = p_1 ;
Packit 67cb25
  j = product ;
Packit 67cb25
Packit 67cb25
  for (k = 1; k < q; k++)
Packit 67cb25
    {
Packit 67cb25
      for (k1 = 0; k1 < p_1; k1++)
Packit 67cb25
        {
Packit 67cb25
          for (e1 = 1; e1 < factor; e1++)
Packit 67cb25
            {
Packit 67cb25
              ATOMIC x_real = REAL(in, istride,i + e1 * m);
Packit 67cb25
              ATOMIC x_imag = IMAG(in, istride,i + e1 * m);
Packit 67cb25
Packit 67cb25
              ATOMIC w_real, w_imag ;
Packit 67cb25
              if (sign == gsl_fft_forward) {
Packit 67cb25
                w_real = GSL_REAL(twiddle[(e1-1)*q + k-1]) ;
Packit 67cb25
                w_imag = GSL_IMAG(twiddle[(e1-1)*q + k-1]) ;
Packit 67cb25
              } else {
Packit 67cb25
                w_real = GSL_REAL(twiddle[(e1-1)*q + k-1]) ;
Packit 67cb25
                w_imag = -GSL_IMAG(twiddle[(e1-1)*q + k-1]) ; 
Packit 67cb25
              }
Packit 67cb25
Packit 67cb25
              REAL(out,ostride,j + e1 * p_1) = w_real * x_real - w_imag * x_imag;
Packit 67cb25
              IMAG(out,ostride,j + e1 * p_1) = w_real * x_imag + w_imag * x_real;
Packit 67cb25
            }
Packit 67cb25
          i++;
Packit 67cb25
          j++;
Packit 67cb25
        }
Packit 67cb25
      j += jump;
Packit 67cb25
    }
Packit 67cb25
Packit 67cb25
  return 0;
Packit 67cb25
}
Packit 67cb25