198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2005-2006 Jean-Marc Valin 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project File: fftwrap.c 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Wrapper for various FFTs 598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Redistribution and use in source and binary forms, with or without 798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project modification, are permitted provided that the following conditions 898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project are met: 998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions of source code must retain the above copyright 1198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer. 1298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions in binary form must reproduce the above copyright 1498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer in the 1598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project documentation and/or other materials provided with the distribution. 1698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Neither the name of the Xiph.org Foundation nor the names of its 1898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project contributors may be used to endorse or promote products derived from 1998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project this software without specific prior written permission. 2098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 2298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 2398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 2498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR 2598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 2698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 2798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 2898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 2998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 3098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 3198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 3298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 3498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef HAVE_CONFIG_H 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "config.h" 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "arch.h" 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "os_support.h" 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define MAX_FFT_SIZE 2048 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef FIXED_POINT 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic int maximize_range(spx_word16_t *in, spx_word16_t *out, spx_word16_t bound, int len) 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i, shift; 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t max_val = 0; 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<len;i++) 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (in[i]>max_val) 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project max_val = in[i]; 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (-in[i]>max_val) 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project max_val = -in[i]; 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project shift=0; 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (max_val <= (bound>>1) && max_val != 0) 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project max_val <<= 1; 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project shift++; 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<len;i++) 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = SHL16(in[i], shift); 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return shift; 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic void renorm_range(spx_word16_t *in, spx_word16_t *out, int shift, int len) 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<len;i++) 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = PSHR16(in[i], shift); 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef USE_SMALLFT 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "smallft.h" 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include <math.h> 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid *spx_fft_init(int size) 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct drft_lookup *table; 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table = speex_alloc(sizeof(struct drft_lookup)); 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_init((struct drft_lookup *)table, size); 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return (void*)table; 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft_destroy(void *table) 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_clear(table); 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project speex_free(table); 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft(void *table, float *in, float *out) 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (in==out) 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float scale = 1./((struct drft_lookup *)table)->n; 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project speex_warning("FFT should not be done in-place"); 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<((struct drft_lookup *)table)->n;i++) 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = scale*in[i]; 10798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 10898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 10998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float scale = 1./((struct drft_lookup *)table)->n; 11098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<((struct drft_lookup *)table)->n;i++) 11198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = scale*in[i]; 11298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 11398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_forward((struct drft_lookup *)table, out); 11498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 11598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 11698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_ifft(void *table, float *in, float *out) 11798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 11898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (in==out) 11998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 12098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project speex_warning("FFT should not be done in-place"); 12198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else { 12298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 12398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<((struct drft_lookup *)table)->n;i++) 12498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = in[i]; 12598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 12698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_backward((struct drft_lookup *)table, out); 12798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 12898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 12998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#elif defined(USE_INTEL_MKL) 13098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include <mkl.h> 13198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 13298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstruct mkl_config { 13398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project DFTI_DESCRIPTOR_HANDLE desc; 13498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int N; 13598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project}; 13698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 13798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid *spx_fft_init(int size) 13898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 13998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct mkl_config *table = (struct mkl_config *) speex_alloc(sizeof(struct mkl_config)); 14098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table->N = size; 14198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project DftiCreateDescriptor(&table->desc, DFTI_SINGLE, DFTI_REAL, 1, size); 14298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project DftiSetValue(table->desc, DFTI_PACKED_FORMAT, DFTI_PACK_FORMAT); 14398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project DftiSetValue(table->desc, DFTI_PLACEMENT, DFTI_NOT_INPLACE); 14498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project DftiSetValue(table->desc, DFTI_FORWARD_SCALE, 1.0f / size); 14598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project DftiCommitDescriptor(table->desc); 14698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return table; 14798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 14898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 14998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft_destroy(void *table) 15098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 15198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct mkl_config *t = (struct mkl_config *) table; 15298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project DftiFreeDescriptor(t->desc); 15398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project speex_free(table); 15498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 15598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 15698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft(void *table, spx_word16_t *in, spx_word16_t *out) 15798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 15898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct mkl_config *t = (struct mkl_config *) table; 15998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project DftiComputeForward(t->desc, in, out); 16098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 16198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_ifft(void *table, spx_word16_t *in, spx_word16_t *out) 16398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 16498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct mkl_config *t = (struct mkl_config *) table; 16598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project DftiComputeBackward(t->desc, in, out); 16698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 16798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 16898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#elif defined(USE_GPL_FFTW3) 16998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include <fftw3.h> 17198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 17298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstruct fftw_config { 17398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float *in; 17498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float *out; 17598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fftwf_plan fft; 17698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fftwf_plan ifft; 17798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int N; 17898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project}; 17998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 18098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid *spx_fft_init(int size) 18198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 18298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct fftw_config *table = (struct fftw_config *) speex_alloc(sizeof(struct fftw_config)); 18398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table->in = fftwf_malloc(sizeof(float) * (size+2)); 18498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table->out = fftwf_malloc(sizeof(float) * (size+2)); 18598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 18698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table->fft = fftwf_plan_dft_r2c_1d(size, table->in, (fftwf_complex *) table->out, FFTW_PATIENT); 18798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table->ifft = fftwf_plan_dft_c2r_1d(size, (fftwf_complex *) table->in, table->out, FFTW_PATIENT); 18898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 18998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table->N = size; 19098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return table; 19198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 19298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 19398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft_destroy(void *table) 19498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 19598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct fftw_config *t = (struct fftw_config *) table; 19698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fftwf_destroy_plan(t->fft); 19798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fftwf_destroy_plan(t->ifft); 19898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fftwf_free(t->in); 19998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fftwf_free(t->out); 20098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project speex_free(table); 20198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 20298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 20398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 20498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft(void *table, spx_word16_t *in, spx_word16_t *out) 20598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 20698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 20798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct fftw_config *t = (struct fftw_config *) table; 20898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project const int N = t->N; 20998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float *iptr = t->in; 21098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float *optr = t->out; 21198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project const float m = 1.0 / N; 21298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for(i=0;i<N;++i) 21398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project iptr[i]=in[i] * m; 21498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 21598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fftwf_execute(t->fft); 21698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 21798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[0] = optr[0]; 21898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for(i=1;i<N;++i) 21998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = optr[i+1]; 22098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 22198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 22298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_ifft(void *table, spx_word16_t *in, spx_word16_t *out) 22398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 22498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 22598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct fftw_config *t = (struct fftw_config *) table; 22698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project const int N = t->N; 22798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float *iptr = t->in; 22898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float *optr = t->out; 22998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 23098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project iptr[0] = in[0]; 23198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project iptr[1] = 0.0f; 23298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for(i=1;i<N;++i) 23398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project iptr[i+1] = in[i]; 23498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project iptr[N+1] = 0.0f; 23598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 23698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project fftwf_execute(t->ifft); 23798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 23898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for(i=0;i<N;++i) 23998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = optr[i]; 24098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 24198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 24298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#elif defined(USE_KISS_FFT) 24398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 24498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "kiss_fftr.h" 24598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "kiss_fft.h" 24698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 24798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstruct kiss_config { 24898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project kiss_fftr_cfg forward; 24998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project kiss_fftr_cfg backward; 25098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int N; 25198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project}; 25298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 25398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid *spx_fft_init(int size) 25498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 25598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct kiss_config *table; 25698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table = (struct kiss_config*)speex_alloc(sizeof(struct kiss_config)); 25798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table->forward = kiss_fftr_alloc(size,0,NULL,NULL); 25898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table->backward = kiss_fftr_alloc(size,1,NULL,NULL); 25998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project table->N = size; 26098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return table; 26198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 26298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 26398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft_destroy(void *table) 26498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 26598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct kiss_config *t = (struct kiss_config *)table; 26698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project kiss_fftr_free(t->forward); 26798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project kiss_fftr_free(t->backward); 26898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project speex_free(table); 26998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 27098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 27198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef FIXED_POINT 27298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 27398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft(void *table, spx_word16_t *in, spx_word16_t *out) 27498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 27598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int shift; 27698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct kiss_config *t = (struct kiss_config *)table; 27798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project shift = maximize_range(in, in, 32000, t->N); 27898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project kiss_fftr2(t->forward, in, out); 27998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project renorm_range(in, in, shift, t->N); 28098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project renorm_range(out, out, shift, t->N); 28198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 28298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 28398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 28498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 28598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft(void *table, spx_word16_t *in, spx_word16_t *out) 28698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 28798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 28898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float scale; 28998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct kiss_config *t = (struct kiss_config *)table; 29098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project scale = 1./t->N; 29198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project kiss_fftr2(t->forward, in, out); 29298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<t->N;i++) 29398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] *= scale; 29498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 29598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 29698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 29798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_ifft(void *table, spx_word16_t *in, spx_word16_t *out) 29898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 29998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct kiss_config *t = (struct kiss_config *)table; 30098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project kiss_fftri2(t->backward, in, out); 30198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 30298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 30398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 30498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 30598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 30698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#error No other FFT implemented 30798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 30898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 30998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 31098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 31198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef FIXED_POINT 31298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/*#include "smallft.h"*/ 31398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 31498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 31598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft_float(void *table, float *in, float *out) 31698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 31798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 31898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef USE_SMALLFT 31998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int N = ((struct drft_lookup *)table)->n; 32098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#elif defined(USE_KISS_FFT) 32198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int N = ((struct kiss_config *)table)->N; 32298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 32398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 32498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef VAR_ARRAYS 32598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t _in[N]; 32698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t _out[N]; 32798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 32898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t _in[MAX_FFT_SIZE]; 32998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t _out[MAX_FFT_SIZE]; 33098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 33198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<N;i++) 33298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project _in[i] = (int)floor(.5+in[i]); 33398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_fft(table, _in, _out); 33498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<N;i++) 33598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = _out[i]; 33698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#if 0 33798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!fixed_point) 33898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 33998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float scale; 34098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct drft_lookup t; 34198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_init(&t, ((struct kiss_config *)table)->N); 34298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project scale = 1./((struct kiss_config *)table)->N; 34398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<((struct kiss_config *)table)->N;i++) 34498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = scale*in[i]; 34598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_forward(&t, out); 34698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_clear(&t); 34798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 34898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 34998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 35098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 35198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_ifft_float(void *table, float *in, float *out) 35298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 35398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 35498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef USE_SMALLFT 35598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int N = ((struct drft_lookup *)table)->n; 35698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#elif defined(USE_KISS_FFT) 35798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int N = ((struct kiss_config *)table)->N; 35898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 35998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 36098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef VAR_ARRAYS 36198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t _in[N]; 36298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t _out[N]; 36398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 36498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t _in[MAX_FFT_SIZE]; 36598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word16_t _out[MAX_FFT_SIZE]; 36698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 36798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<N;i++) 36898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project _in[i] = (int)floor(.5+in[i]); 36998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_ifft(table, _in, _out); 37098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<N;i++) 37198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = _out[i]; 37298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#if 0 37398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (!fixed_point) 37498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 37598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i; 37698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project struct drft_lookup t; 37798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_init(&t, ((struct kiss_config *)table)->N); 37898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<((struct kiss_config *)table)->N;i++) 37998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project out[i] = in[i]; 38098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_backward(&t, out); 38198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_drft_clear(&t); 38298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 38398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 38498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 38598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 38698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 38798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 38898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_fft_float(void *table, float *in, float *out) 38998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 39098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_fft(table, in, out); 39198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 39298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid spx_ifft_float(void *table, float *in, float *out) 39398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 39498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_ifft(table, in, out); 39598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 39698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 39798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 398