2 Copyright (C) 2003-2009 Paul Brossier <piem@aubio.org>
4 This file is part of aubio.
6 aubio is free software: you can redistribute it and/or modify
7 it under the terms of the GNU General Public License as published by
8 the Free Software Foundation, either version 3 of the License, or
9 (at your option) any later version.
11 aubio is distributed in the hope that it will be useful,
12 but WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 GNU General Public License for more details.
16 You should have received a copy of the GNU General Public License
17 along with aubio. If not, see <http://www.gnu.org/licenses/>.
21 #include "aubio_priv.h"
24 #include "mathutils.h"
25 #include "spectral/fft.h"
27 #ifdef HAVE_FFTW3 // using FFTW3
28 /* note that <complex.h> is not included here but only in aubio_priv.h, so that
29 * c++ projects can still use their own complex definition. */
35 /** fft data type with complex.h and fftw3f */
36 #define FFTW_TYPE fftwf_complex
38 /** fft data type with complex.h and fftw3 */
39 #define FFTW_TYPE fftw_complex
43 /** fft data type without complex.h and with fftw3f */
44 #define FFTW_TYPE float
46 /** fft data type without complex.h and with fftw */
47 #define FFTW_TYPE double
52 typedef FFTW_TYPE fft_data_t;
55 #define fftw_malloc fftwf_malloc
56 #define fftw_free fftwf_free
57 #define fftw_execute fftwf_execute
58 #define fftw_plan_dft_r2c_1d fftwf_plan_dft_r2c_1d
59 #define fftw_plan_dft_c2r_1d fftwf_plan_dft_c2r_1d
60 #define fftw_plan_r2r_1d fftwf_plan_r2r_1d
61 #define fftw_plan fftwf_plan
62 #define fftw_destroy_plan fftwf_destroy_plan
67 #error "Using aubio in double precision with fftw3 in single precision"
68 #endif /* HAVE_AUBIO_DOUBLE */
70 #elif defined (HAVE_FFTW3) /* HAVE_FFTW3F */
71 #if !HAVE_AUBIO_DOUBLE
72 #error "Using aubio in single precision with fftw3 in double precision"
73 #endif /* HAVE_AUBIO_DOUBLE */
75 #endif /* HAVE_FFTW3F */
77 // a global mutex for FFTW thread safety
78 pthread_mutex_t aubio_fftw_mutex = PTHREAD_MUTEX_INITIALIZER;
81 #ifdef HAVE_ACCELERATE // using ACCELERATE
82 // https://developer.apple.com/library/mac/#documentation/Accelerate/Reference/vDSPRef/Reference/reference.html
83 #include <Accelerate/Accelerate.h>
85 #if !HAVE_AUBIO_DOUBLE
86 #define aubio_vDSP_ctoz vDSP_ctoz
87 #define aubio_vDSP_fft_zrip vDSP_fft_zrip
88 #define aubio_vDSP_ztoc vDSP_ztoc
89 #define aubio_vDSP_zvmags vDSP_zvmags
90 #define aubio_vDSP_zvphas vDSP_zvphas
91 #define aubio_vDSP_vsadd vDSP_vsadd
92 #define aubio_vDSP_vsmul vDSP_vsmul
93 #define aubio_vDSP_create_fftsetup vDSP_create_fftsetup
94 #define aubio_vDSP_destroy_fftsetup vDSP_destroy_fftsetup
95 #define aubio_DSPComplex DSPComplex
96 #define aubio_DSPSplitComplex DSPSplitComplex
97 #define aubio_FFTSetup FFTSetup
98 #define aubio_vvsqrt vvsqrtf
100 #define aubio_vDSP_ctoz vDSP_ctozD
101 #define aubio_vDSP_fft_zrip vDSP_fft_zripD
102 #define aubio_vDSP_ztoc vDSP_ztocD
103 #define aubio_vDSP_zvmags vDSP_zvmagsD
104 #define aubio_vDSP_zvphas vDSP_zvphasD
105 #define aubio_vDSP_vsadd vDSP_vsaddD
106 #define aubio_vDSP_vsmul vDSP_vsmulD
107 #define aubio_vDSP_create_fftsetup vDSP_create_fftsetupD
108 #define aubio_vDSP_destroy_fftsetup vDSP_destroy_fftsetupD
109 #define aubio_DSPComplex DSPDoubleComplex
110 #define aubio_DSPSplitComplex DSPDoubleSplitComplex
111 #define aubio_FFTSetup FFTSetupD
112 #define aubio_vvsqrt vvsqrt
113 #endif /* HAVE_AUBIO_DOUBLE */
116 // let's use ooura instead
117 extern void rdft(int, int, smpl_t *, int *, smpl_t *);
119 #endif /* HAVE_ACCELERATE */
120 #endif /* HAVE_FFTW3 */
122 struct _aubio_fft_t {
125 #ifdef HAVE_FFTW3 // using FFTW3
128 fft_data_t * specdata; /* complex spectral data */
130 #ifdef HAVE_ACCELERATE // using ACCELERATE
132 aubio_FFTSetup fftSetup;
133 aubio_DSPSplitComplex spec;
139 #endif /* HAVE_ACCELERATE */
140 #endif /* HAVE_FFTW3 */
144 aubio_fft_t * new_aubio_fft (uint_t winsize) {
145 aubio_fft_t * s = AUBIO_NEW(aubio_fft_t);
146 if ((sint_t)winsize < 2) {
147 AUBIO_ERR("fft: got winsize %d, but can not be < 2\n", winsize);
152 s->winsize = winsize;
153 /* allocate memory */
154 s->in = AUBIO_ARRAY(real_t,winsize);
155 s->out = AUBIO_ARRAY(real_t,winsize);
156 s->compspec = new_fvec(winsize);
158 pthread_mutex_lock(&aubio_fftw_mutex);
159 #ifdef HAVE_COMPLEX_H
160 s->fft_size = winsize/2 + 1;
161 s->specdata = (fft_data_t*)fftw_malloc(sizeof(fft_data_t)*s->fft_size);
162 s->pfw = fftw_plan_dft_r2c_1d(winsize, s->in, s->specdata, FFTW_ESTIMATE);
163 s->pbw = fftw_plan_dft_c2r_1d(winsize, s->specdata, s->out, FFTW_ESTIMATE);
165 s->fft_size = winsize;
166 s->specdata = (fft_data_t*)fftw_malloc(sizeof(fft_data_t)*s->fft_size);
167 s->pfw = fftw_plan_r2r_1d(winsize, s->in, s->specdata, FFTW_R2HC, FFTW_ESTIMATE);
168 s->pbw = fftw_plan_r2r_1d(winsize, s->specdata, s->out, FFTW_HC2R, FFTW_ESTIMATE);
170 pthread_mutex_unlock(&aubio_fftw_mutex);
171 for (i = 0; i < s->winsize; i++) {
175 for (i = 0; i < s->fft_size; i++) {
179 #ifdef HAVE_ACCELERATE // using ACCELERATE
180 s->winsize = winsize;
181 s->fft_size = winsize;
182 s->compspec = new_fvec(winsize);
183 s->log2fftsize = (uint_t)log2f(s->fft_size);
184 s->in = AUBIO_ARRAY(smpl_t, s->fft_size);
185 s->out = AUBIO_ARRAY(smpl_t, s->fft_size);
186 s->spec.realp = AUBIO_ARRAY(smpl_t, s->fft_size/2);
187 s->spec.imagp = AUBIO_ARRAY(smpl_t, s->fft_size/2);
188 s->fftSetup = aubio_vDSP_create_fftsetup(s->log2fftsize, FFT_RADIX2);
190 if (aubio_is_power_of_two(winsize) != 1) {
191 AUBIO_ERR("fft: can only create with sizes power of two,"
192 " requested %d\n", winsize);
195 s->winsize = winsize;
196 s->fft_size = winsize / 2 + 1;
197 s->compspec = new_fvec(winsize);
198 s->in = AUBIO_ARRAY(smpl_t, s->winsize);
199 s->out = AUBIO_ARRAY(smpl_t, s->winsize);
200 s->ip = AUBIO_ARRAY(int , s->fft_size);
201 s->w = AUBIO_ARRAY(smpl_t, s->fft_size);
203 #endif /* HAVE_ACCELERATE */
204 #endif /* HAVE_FFTW3 */
211 void del_aubio_fft(aubio_fft_t * s) {
213 del_fvec(s->compspec);
214 #ifdef HAVE_FFTW3 // using FFTW3
215 fftw_destroy_plan(s->pfw);
216 fftw_destroy_plan(s->pbw);
217 fftw_free(s->specdata);
218 #else /* HAVE_FFTW3 */
219 #ifdef HAVE_ACCELERATE // using ACCELERATE
220 AUBIO_FREE(s->spec.realp);
221 AUBIO_FREE(s->spec.imagp);
222 aubio_vDSP_destroy_fftsetup(s->fftSetup);
226 #endif /* HAVE_ACCELERATE */
227 #endif /* HAVE_FFTW3 */
233 void aubio_fft_do(aubio_fft_t * s, const fvec_t * input, cvec_t * spectrum) {
234 aubio_fft_do_complex(s, input, s->compspec);
235 aubio_fft_get_spectrum(s->compspec, spectrum);
238 void aubio_fft_rdo(aubio_fft_t * s, const cvec_t * spectrum, fvec_t * output) {
239 aubio_fft_get_realimag(spectrum, s->compspec);
240 aubio_fft_rdo_complex(s, s->compspec, output);
243 void aubio_fft_do_complex(aubio_fft_t * s, const fvec_t * input, fvec_t * compspec) {
245 #ifndef HAVE_MEMCPY_HACKS
246 for (i=0; i < s->winsize; i++) {
247 s->in[i] = input->data[i];
250 memcpy(s->in, input->data, s->winsize * sizeof(smpl_t));
251 #endif /* HAVE_MEMCPY_HACKS */
252 #ifdef HAVE_FFTW3 // using FFTW3
253 fftw_execute(s->pfw);
254 #ifdef HAVE_COMPLEX_H
255 compspec->data[0] = REAL(s->specdata[0]);
256 for (i = 1; i < s->fft_size -1 ; i++) {
257 compspec->data[i] = REAL(s->specdata[i]);
258 compspec->data[compspec->length - i] = IMAG(s->specdata[i]);
260 compspec->data[s->fft_size-1] = REAL(s->specdata[s->fft_size-1]);
261 #else /* HAVE_COMPLEX_H */
262 for (i = 0; i < s->fft_size; i++) {
263 compspec->data[i] = s->specdata[i];
265 #endif /* HAVE_COMPLEX_H */
266 #else /* HAVE_FFTW3 */
267 #ifdef HAVE_ACCELERATE // using ACCELERATE
268 // convert real data to even/odd format used in vDSP
269 aubio_vDSP_ctoz((aubio_DSPComplex*)s->in, 2, &s->spec, 1, s->fft_size/2);
271 aubio_vDSP_fft_zrip(s->fftSetup, &s->spec, 1, s->log2fftsize, FFT_FORWARD);
272 // convert from vDSP complex split to [ r0, r1, ..., rN, iN-1, .., i2, i1]
273 compspec->data[0] = s->spec.realp[0];
274 compspec->data[s->fft_size / 2] = s->spec.imagp[0];
275 for (i = 1; i < s->fft_size / 2; i++) {
276 compspec->data[i] = s->spec.realp[i];
277 compspec->data[s->fft_size - i] = s->spec.imagp[i];
280 smpl_t scale = 1./2.;
281 aubio_vDSP_vsmul(compspec->data, 1, &scale, compspec->data, 1, s->fft_size);
283 rdft(s->winsize, 1, s->in, s->ip, s->w);
284 compspec->data[0] = s->in[0];
285 compspec->data[s->winsize / 2] = s->in[1];
286 for (i = 1; i < s->fft_size - 1; i++) {
287 compspec->data[i] = s->in[2 * i];
288 compspec->data[s->winsize - i] = - s->in[2 * i + 1];
290 #endif /* HAVE_ACCELERATE */
291 #endif /* HAVE_FFTW3 */
294 void aubio_fft_rdo_complex(aubio_fft_t * s, const fvec_t * compspec, fvec_t * output) {
297 const smpl_t renorm = 1./(smpl_t)s->winsize;
298 #ifdef HAVE_COMPLEX_H
299 s->specdata[0] = compspec->data[0];
300 for (i=1; i < s->fft_size - 1; i++) {
301 s->specdata[i] = compspec->data[i] +
302 I * compspec->data[compspec->length - i];
304 s->specdata[s->fft_size - 1] = compspec->data[s->fft_size - 1];
306 for (i=0; i < s->fft_size; i++) {
307 s->specdata[i] = compspec->data[i];
310 fftw_execute(s->pbw);
311 for (i = 0; i < output->length; i++) {
312 output->data[i] = s->out[i]*renorm;
314 #else /* HAVE_FFTW3 */
315 #ifdef HAVE_ACCELERATE // using ACCELERATE
316 // convert from real imag [ r0, r1, ..., rN, iN-1, .., i2, i1]
317 // to vDSP packed format [ r0, rN, r1, i1, ..., rN-1, iN-1 ]
318 s->out[0] = compspec->data[0];
319 s->out[1] = compspec->data[s->winsize / 2];
320 for (i = 1; i < s->fft_size / 2; i++) {
321 s->out[2 * i] = compspec->data[i];
322 s->out[2 * i + 1] = compspec->data[s->winsize - i];
324 // convert to split complex format used in vDSP
325 aubio_vDSP_ctoz((aubio_DSPComplex*)s->out, 2, &s->spec, 1, s->fft_size/2);
327 aubio_vDSP_fft_zrip(s->fftSetup, &s->spec, 1, s->log2fftsize, FFT_INVERSE);
328 // convert result to real output
329 aubio_vDSP_ztoc(&s->spec, 1, (aubio_DSPComplex*)output->data, 2, s->fft_size/2);
331 smpl_t scale = 1.0 / s->winsize;
332 aubio_vDSP_vsmul(output->data, 1, &scale, output->data, 1, s->fft_size);
334 smpl_t scale = 2.0 / s->winsize;
335 s->out[0] = compspec->data[0];
336 s->out[1] = compspec->data[s->winsize / 2];
337 for (i = 1; i < s->fft_size - 1; i++) {
338 s->out[2 * i] = compspec->data[i];
339 s->out[2 * i + 1] = - compspec->data[s->winsize - i];
341 rdft(s->winsize, -1, s->out, s->ip, s->w);
342 for (i=0; i < s->winsize; i++) {
343 output->data[i] = s->out[i] * scale;
345 #endif /* HAVE_ACCELERATE */
346 #endif /* HAVE_FFTW3 */
349 void aubio_fft_get_spectrum(const fvec_t * compspec, cvec_t * spectrum) {
350 aubio_fft_get_phas(compspec, spectrum);
351 aubio_fft_get_norm(compspec, spectrum);
354 void aubio_fft_get_realimag(const cvec_t * spectrum, fvec_t * compspec) {
355 aubio_fft_get_imag(spectrum, compspec);
356 aubio_fft_get_real(spectrum, compspec);
359 void aubio_fft_get_phas(const fvec_t * compspec, cvec_t * spectrum) {
361 if (compspec->data[0] < 0) {
362 spectrum->phas[0] = PI;
364 spectrum->phas[0] = 0.;
366 for (i=1; i < spectrum->length - 1; i++) {
367 spectrum->phas[i] = ATAN2(compspec->data[compspec->length-i],
370 if (compspec->data[compspec->length/2] < 0) {
371 spectrum->phas[spectrum->length - 1] = PI;
373 spectrum->phas[spectrum->length - 1] = 0.;
377 void aubio_fft_get_norm(const fvec_t * compspec, cvec_t * spectrum) {
379 spectrum->norm[0] = ABS(compspec->data[0]);
380 for (i=1; i < spectrum->length - 1; i++) {
381 spectrum->norm[i] = SQRT(SQR(compspec->data[i])
382 + SQR(compspec->data[compspec->length - i]) );
384 spectrum->norm[spectrum->length-1] =
385 ABS(compspec->data[compspec->length/2]);
388 void aubio_fft_get_imag(const cvec_t * spectrum, fvec_t * compspec) {
390 for (i = 1; i < ( compspec->length + 1 ) / 2 /*- 1 + 1*/; i++) {
391 compspec->data[compspec->length - i] =
392 spectrum->norm[i]*SIN(spectrum->phas[i]);
396 void aubio_fft_get_real(const cvec_t * spectrum, fvec_t * compspec) {
398 for (i = 0; i < compspec->length / 2 + 1; i++) {
400 spectrum->norm[i]*COS(spectrum->phas[i]);