|
Packit |
67cb25 |
/* fft/real_init.c
|
|
Packit |
67cb25 |
*
|
|
Packit |
67cb25 |
* Copyright (C) 1996, 1997, 1998, 1999, 2000, 2007, 2009 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 |
TYPE(gsl_fft_real_wavetable) *
|
|
Packit |
67cb25 |
FUNCTION(gsl_fft_real_wavetable,alloc) (size_t n)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
int status;
|
|
Packit |
67cb25 |
size_t i;
|
|
Packit |
67cb25 |
size_t n_factors;
|
|
Packit |
67cb25 |
size_t t, product, product_1, q;
|
|
Packit |
67cb25 |
double d_theta;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
TYPE(gsl_fft_real_wavetable) * wavetable;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
if (n == 0)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
GSL_ERROR_VAL ("length n must be positive integer", GSL_EDOM, 0);
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
wavetable = (TYPE(gsl_fft_real_wavetable) *)
|
|
Packit |
67cb25 |
malloc(sizeof(TYPE(gsl_fft_real_wavetable)));
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
if (wavetable == NULL)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
GSL_ERROR_VAL ("failed to allocate struct", GSL_ENOMEM, 0);
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
if (n == 1)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
wavetable->trig = 0;
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
else
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
wavetable->trig = (TYPE(gsl_complex) *)
|
|
Packit |
67cb25 |
malloc ((n / 2) * sizeof (TYPE(gsl_complex)));
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
if (wavetable->trig == NULL)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
/* error in constructor, prevent memory leak */
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
free(wavetable) ;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
GSL_ERROR_VAL ("failed to allocate trigonometric lookup table",
|
|
Packit |
67cb25 |
GSL_ENOMEM, 0);
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
wavetable->n = n;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
status = fft_real_factorize (n, &n_factors, wavetable->factor);
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
if (status)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
/* error in constructor, prevent memory leak */
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
free(wavetable->trig);
|
|
Packit |
67cb25 |
free(wavetable) ;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
GSL_ERROR_VAL ("factorization failed", GSL_EFACTOR, 0);
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
wavetable->nf = n_factors;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
d_theta = 2.0 * M_PI / ((double) n);
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
t = 0;
|
|
Packit |
67cb25 |
product = 1;
|
|
Packit |
67cb25 |
for (i = 0; i < wavetable->nf; i++)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
size_t j;
|
|
Packit |
67cb25 |
const size_t factor = wavetable->factor[i];
|
|
Packit |
67cb25 |
wavetable->twiddle[i] = wavetable->trig + t;
|
|
Packit |
67cb25 |
product_1 = product; /* product_1 = p_(i-1) */
|
|
Packit |
67cb25 |
product *= factor;
|
|
Packit |
67cb25 |
q = n / product;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
for (j = 1; j < factor; j++)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
size_t k;
|
|
Packit |
67cb25 |
size_t m = 0;
|
|
Packit |
67cb25 |
for (k = 1; k < (product_1 + 1) / 2; k++)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
double theta;
|
|
Packit |
67cb25 |
m = m + j * q;
|
|
Packit |
67cb25 |
m = m % n;
|
|
Packit |
67cb25 |
theta = d_theta * m; /* d_theta*j*k*q */
|
|
Packit |
67cb25 |
GSL_REAL(wavetable->trig[t]) = cos (theta);
|
|
Packit |
67cb25 |
GSL_IMAG(wavetable->trig[t]) = sin (theta);
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
t++;
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
if (t > (n / 2))
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
/* error in constructor, prevent memory leak */
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
free(wavetable->trig);
|
|
Packit |
67cb25 |
free(wavetable) ;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
GSL_ERROR_VAL ("overflowed trigonometric lookup table",
|
|
Packit |
67cb25 |
GSL_ESANITY, 0);
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
return wavetable;
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
TYPE(gsl_fft_real_workspace) *
|
|
Packit |
67cb25 |
FUNCTION(gsl_fft_real_workspace,alloc) (size_t n)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
TYPE(gsl_fft_real_workspace) * workspace;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
if (n == 0)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
GSL_ERROR_VAL ("length n must be positive integer", GSL_EDOM, 0);
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
workspace = (TYPE(gsl_fft_real_workspace) *)
|
|
Packit |
67cb25 |
malloc(sizeof(TYPE(gsl_fft_real_workspace)));
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
if (workspace == NULL)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
GSL_ERROR_VAL ("failed to allocate struct", GSL_ENOMEM, 0);
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
workspace->n = n;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
workspace->scratch = (BASE *) malloc (n * sizeof (BASE));
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
if (workspace->scratch == NULL)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
/* error in constructor, prevent memory leak */
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
free(workspace) ;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
GSL_ERROR_VAL ("failed to allocate scratch space", GSL_ENOMEM, 0);
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
return workspace;
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
void
|
|
Packit |
67cb25 |
FUNCTION(gsl_fft_real_wavetable,free) (TYPE(gsl_fft_real_wavetable) * wavetable)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
RETURN_IF_NULL (wavetable);
|
|
Packit |
67cb25 |
/* release trigonometric lookup tables */
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
free (wavetable->trig);
|
|
Packit |
67cb25 |
wavetable->trig = NULL;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
free (wavetable) ;
|
|
Packit |
67cb25 |
}
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
void
|
|
Packit |
67cb25 |
FUNCTION(gsl_fft_real_workspace,free) (TYPE(gsl_fft_real_workspace) * workspace)
|
|
Packit |
67cb25 |
{
|
|
Packit |
67cb25 |
RETURN_IF_NULL (workspace);
|
|
Packit |
67cb25 |
/* release scratch space */
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
free (workspace->scratch);
|
|
Packit |
67cb25 |
workspace->scratch = NULL;
|
|
Packit |
67cb25 |
|
|
Packit |
67cb25 |
free (workspace) ;
|
|
Packit |
67cb25 |
}
|