1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
|
/* fft/hc_init.c
*
* Copyright (C) 1996, 1997, 1998, 1999, 2000 Brian Gough
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or (at
* your option) any later version.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
*/
TYPE(gsl_fft_halfcomplex_wavetable) *
FUNCTION(gsl_fft_halfcomplex_wavetable,alloc) (size_t n)
{
int status;
size_t i;
size_t n_factors;
size_t t, product, product_1, q;
double d_theta;
TYPE(gsl_fft_halfcomplex_wavetable) * wavetable ;
if (n == 0)
{
GSL_ERROR_VAL ("length n must be positive integer", GSL_EDOM, 0);
}
wavetable = (TYPE(gsl_fft_halfcomplex_wavetable) *)
malloc(sizeof(TYPE(gsl_fft_halfcomplex_wavetable)));
if (wavetable == NULL)
{
GSL_ERROR_VAL ("failed to allocate struct", GSL_ENOMEM, 0);
}
wavetable->trig = (TYPE(gsl_complex) *) malloc (n * sizeof (TYPE(gsl_complex)));
if (wavetable->trig == NULL)
{
/* error in constructor, prevent memory leak */
free(wavetable) ;
GSL_ERROR_VAL ("failed to allocate trigonometric lookup table",
GSL_ENOMEM, 0);
}
wavetable->n = n ;
status = fft_halfcomplex_factorize (n, &n_factors, wavetable->factor);
if (status)
{
/* error in constructor, prevent memory leak */
free(wavetable->trig) ;
free(wavetable) ;
GSL_ERROR_VAL ("factorization failed", GSL_EFACTOR, 0);
}
wavetable->nf = n_factors;
d_theta = 2.0 * M_PI / ((double) n);
t = 0;
product = 1;
for (i = 0; i < n_factors; i++)
{
size_t j;
const size_t factor = wavetable->factor[i];
wavetable->twiddle[i] = wavetable->trig + t;
product_1 = product; /* product_1 = p_(i-1) */
product *= factor;
q = n / product;
for (j = 1; j < factor; j++)
{
size_t k;
size_t m = 0;
for (k = 1; k < (q + 1) / 2; k++)
{
double theta;
m = m + j * product_1;
m = m % n;
theta = d_theta * m; /* d_theta*j*k*product_1 */
GSL_REAL(wavetable->trig[t]) = cos (theta);
GSL_IMAG(wavetable->trig[t]) = sin (theta);
t++;
}
}
}
if (t > (n / 2))
{
/* error in constructor, prevent memory leak */
free(wavetable->trig) ;
free(wavetable) ;
GSL_ERROR_VAL ("overflowed trigonometric lookup table", GSL_ESANITY, 0);
}
return wavetable;
}
void
FUNCTION(gsl_fft_halfcomplex_wavetable,free) (TYPE(gsl_fft_halfcomplex_wavetable) * wavetable)
{
/* release trigonometric lookup tables */
free (wavetable->trig);
wavetable->trig = NULL;
free (wavetable);
}
|