=Norig) twidx-=Norig;
+ C_MUL(t,scratch[q] , twiddles[twidx] );
+ C_ADDTO( Fout[ k ] ,t);
+ }
+ k += m;
+ }
+ }
+ KISS_FFT_TMP_FREE(scratch);
+}
+
+static
+void kf_work(
+ kiss_fft_cpx * Fout,
+ const kiss_fft_cpx * f,
+ const size_t fstride,
+ int in_stride,
+ int * factors,
+ const kiss_fft_cfg st
+ )
+{
+ kiss_fft_cpx * Fout_beg=Fout;
+ const int p=*factors++; /* the radix */
+ const int m=*factors++; /* stage's fft length/p */
+ const kiss_fft_cpx * Fout_end = Fout + p*m;
+
+#ifdef _OPENMP
+ // use openmp extensions at the
+ // top-level (not recursive)
+ if (fstride==1 && p<=5)
+ {
+ int k;
+
+ // execute the p different work units in different threads
+# pragma omp parallel for
+ for (k=0;k floor_sqrt)
+ p = n; /* no more factors, skip to end */
+ }
+ n /= p;
+ *facbuf++ = p;
+ *facbuf++ = n;
+ } while (n > 1);
+}
+
+/*
+ *
+ * User-callable function to allocate all necessary storage space for the fft.
+ *
+ * The return value is a contiguous block of memory, allocated with malloc. As such,
+ * It can be freed with free(), rather than a kiss_fft-specific function.
+ * */
+kiss_fft_cfg kiss_fft_alloc(int nfft,int inverse_fft,void * mem,size_t * lenmem )
+{
+ kiss_fft_cfg st=NULL;
+ size_t memneeded = sizeof(struct kiss_fft_state)
+ + sizeof(kiss_fft_cpx)*(nfft-1); /* twiddle factors*/
+
+ if ( lenmem==NULL ) {
+ st = ( kiss_fft_cfg)KISS_FFT_MALLOC( memneeded );
+ }else{
+ if (mem != NULL && *lenmem >= memneeded)
+ st = (kiss_fft_cfg)mem;
+ *lenmem = memneeded;
+ }
+ if (st) {
+ int i;
+ st->nfft=nfft;
+ st->inverse = inverse_fft;
+
+ for (i=0;iinverse)
+ phase *= -1;
+ kf_cexp(st->twiddles+i, phase );
+ }
+
+ kf_factor(nfft,st->factors);
+ }
+ return st;
+}
+
+
+void kiss_fft_stride(kiss_fft_cfg st,const kiss_fft_cpx *fin,kiss_fft_cpx *fout,int in_stride)
+{
+ if (fin == fout) {
+ //NOTE: this is not really an in-place FFT algorithm.
+ //It just performs an out-of-place FFT into a temp buffer
+ kiss_fft_cpx * tmpbuf = (kiss_fft_cpx*)KISS_FFT_TMP_ALLOC( sizeof(kiss_fft_cpx)*st->nfft);
+ kf_work(tmpbuf,fin,1,in_stride, st->factors,st);
+ memcpy(fout,tmpbuf,sizeof(kiss_fft_cpx)*st->nfft);
+ KISS_FFT_TMP_FREE(tmpbuf);
+ }else{
+ kf_work( fout, fin, 1,in_stride, st->factors,st );
+ }
+}
+
+void kiss_fft(kiss_fft_cfg cfg,const kiss_fft_cpx *fin,kiss_fft_cpx *fout)
+{
+ kiss_fft_stride(cfg,fin,fout,1);
+}
+
+
+void kiss_fft_cleanup(void)
+{
+ // nothing needed any more
+}
+
+int kiss_fft_next_fast_size(int n)
+{
+ while(1) {
+ int m=n;
+ while ( (m%2) == 0 ) m/=2;
+ while ( (m%3) == 0 ) m/=3;
+ while ( (m%5) == 0 ) m/=5;
+ if (m<=1)
+ break; /* n is completely factorable by twos, threes, and fives */
+ n++;
+ }
+ return n;
+}
diff --git a/thirdparty/kiss_fft130/kiss_fft.h b/thirdparty/kiss_fft130/kiss_fft.h
new file mode 100644
index 00000000..64c50f4a
--- /dev/null
+++ b/thirdparty/kiss_fft130/kiss_fft.h
@@ -0,0 +1,124 @@
+#ifndef KISS_FFT_H
+#define KISS_FFT_H
+
+#include
+#include
+#include
+#include
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/*
+ ATTENTION!
+ If you would like a :
+ -- a utility that will handle the caching of fft objects
+ -- real-only (no imaginary time component ) FFT
+ -- a multi-dimensional FFT
+ -- a command-line utility to perform ffts
+ -- a command-line utility to perform fast-convolution filtering
+
+ Then see kfc.h kiss_fftr.h kiss_fftnd.h fftutil.c kiss_fastfir.c
+ in the tools/ directory.
+*/
+
+#ifdef USE_SIMD
+# include
+# define kiss_fft_scalar __m128
+#define KISS_FFT_MALLOC(nbytes) _mm_malloc(nbytes,16)
+#define KISS_FFT_FREE _mm_free
+#else
+#define KISS_FFT_MALLOC malloc
+#define KISS_FFT_FREE free
+#endif
+
+
+#ifdef FIXED_POINT
+#include
+# if (FIXED_POINT == 32)
+# define kiss_fft_scalar int32_t
+# else
+# define kiss_fft_scalar int16_t
+# endif
+#else
+# ifndef kiss_fft_scalar
+/* default is float */
+# define kiss_fft_scalar float
+# endif
+#endif
+
+typedef struct {
+ kiss_fft_scalar r;
+ kiss_fft_scalar i;
+}kiss_fft_cpx;
+
+typedef struct kiss_fft_state* kiss_fft_cfg;
+
+/*
+ * kiss_fft_alloc
+ *
+ * Initialize a FFT (or IFFT) algorithm's cfg/state buffer.
+ *
+ * typical usage: kiss_fft_cfg mycfg=kiss_fft_alloc(1024,0,NULL,NULL);
+ *
+ * The return value from fft_alloc is a cfg buffer used internally
+ * by the fft routine or NULL.
+ *
+ * If lenmem is NULL, then kiss_fft_alloc will allocate a cfg buffer using malloc.
+ * The returned value should be free()d when done to avoid memory leaks.
+ *
+ * The state can be placed in a user supplied buffer 'mem':
+ * If lenmem is not NULL and mem is not NULL and *lenmem is large enough,
+ * then the function places the cfg in mem and the size used in *lenmem
+ * and returns mem.
+ *
+ * If lenmem is not NULL and ( mem is NULL or *lenmem is not large enough),
+ * then the function returns NULL and places the minimum cfg
+ * buffer size in *lenmem.
+ * */
+
+kiss_fft_cfg kiss_fft_alloc(int nfft,int inverse_fft,void * mem,size_t * lenmem);
+
+/*
+ * kiss_fft(cfg,in_out_buf)
+ *
+ * Perform an FFT on a complex input buffer.
+ * for a forward FFT,
+ * fin should be f[0] , f[1] , ... ,f[nfft-1]
+ * fout will be F[0] , F[1] , ... ,F[nfft-1]
+ * Note that each element is complex and can be accessed like
+ f[k].r and f[k].i
+ * */
+void kiss_fft(kiss_fft_cfg cfg,const kiss_fft_cpx *fin,kiss_fft_cpx *fout);
+
+/*
+ A more generic version of the above function. It reads its input from every Nth sample.
+ * */
+void kiss_fft_stride(kiss_fft_cfg cfg,const kiss_fft_cpx *fin,kiss_fft_cpx *fout,int fin_stride);
+
+/* If kiss_fft_alloc allocated a buffer, it is one contiguous
+ buffer and can be simply free()d when no longer needed*/
+#define kiss_fft_free free
+
+/*
+ Cleans up some memory that gets managed internally. Not necessary to call, but it might clean up
+ your compiler output to call this before you exit.
+*/
+void kiss_fft_cleanup(void);
+
+
+/*
+ * Returns the smallest integer k, such that k>=n and k has only "fast" factors (2,3,5)
+ */
+int kiss_fft_next_fast_size(int n);
+
+/* for real ffts, we need an even size */
+#define kiss_fftr_next_fast_size_real(n) \
+ (kiss_fft_next_fast_size( ((n)+1)>>1)<<1)
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
diff --git a/thirdparty/kiss_fft130/kissfft.hh b/thirdparty/kiss_fft130/kissfft.hh
new file mode 100644
index 00000000..a586cb11
--- /dev/null
+++ b/thirdparty/kiss_fft130/kissfft.hh
@@ -0,0 +1,299 @@
+#ifndef KISSFFT_CLASS_HH
+#include
+#include
+
+namespace kissfft_utils {
+
+template
+struct traits
+{
+ typedef T_scalar scalar_type;
+ typedef std::complex cpx_type;
+ void fill_twiddles( std::complex * dst ,int nfft,bool inverse)
+ {
+ T_scalar phinc = (inverse?2:-2)* acos( (T_scalar) -1) / nfft;
+ for (int i=0;i(0,i*phinc) );
+ }
+
+ void prepare(
+ std::vector< std::complex > & dst,
+ int nfft,bool inverse,
+ std::vector & stageRadix,
+ std::vector & stageRemainder )
+ {
+ _twiddles.resize(nfft);
+ fill_twiddles( &_twiddles[0],nfft,inverse);
+ dst = _twiddles;
+
+ //factorize
+ //start factoring out 4's, then 2's, then 3,5,7,9,...
+ int n= nfft;
+ int p=4;
+ do {
+ while (n % p) {
+ switch (p) {
+ case 4: p = 2; break;
+ case 2: p = 3; break;
+ default: p += 2; break;
+ }
+ if (p*p>n)
+ p=n;// no more factors
+ }
+ n /= p;
+ stageRadix.push_back(p);
+ stageRemainder.push_back(n);
+ }while(n>1);
+ }
+ std::vector _twiddles;
+
+
+ const cpx_type twiddle(int i) { return _twiddles[i]; }
+};
+
+}
+
+template
+ >
+class kissfft
+{
+ public:
+ typedef T_traits traits_type;
+ typedef typename traits_type::scalar_type scalar_type;
+ typedef typename traits_type::cpx_type cpx_type;
+
+ kissfft(int nfft,bool inverse,const traits_type & traits=traits_type() )
+ :_nfft(nfft),_inverse(inverse),_traits(traits)
+ {
+ _traits.prepare(_twiddles, _nfft,_inverse ,_stageRadix, _stageRemainder);
+ }
+
+ void transform(const cpx_type * src , cpx_type * dst)
+ {
+ kf_work(0, dst, src, 1,1);
+ }
+
+ private:
+ void kf_work( int stage,cpx_type * Fout, const cpx_type * f, size_t fstride,size_t in_stride)
+ {
+ int p = _stageRadix[stage];
+ int m = _stageRemainder[stage];
+ cpx_type * Fout_beg = Fout;
+ cpx_type * Fout_end = Fout + p*m;
+
+ if (m==1) {
+ do{
+ *Fout = *f;
+ f += fstride*in_stride;
+ }while(++Fout != Fout_end );
+ }else{
+ do{
+ // recursive call:
+ // DFT of size m*p performed by doing
+ // p instances of smaller DFTs of size m,
+ // each one takes a decimated version of the input
+ kf_work(stage+1, Fout , f, fstride*p,in_stride);
+ f += fstride*in_stride;
+ }while( (Fout += m) != Fout_end );
+ }
+
+ Fout=Fout_beg;
+
+ // recombine the p smaller DFTs
+ switch (p) {
+ case 2: kf_bfly2(Fout,fstride,m); break;
+ case 3: kf_bfly3(Fout,fstride,m); break;
+ case 4: kf_bfly4(Fout,fstride,m); break;
+ case 5: kf_bfly5(Fout,fstride,m); break;
+ default: kf_bfly_generic(Fout,fstride,m,p); break;
+ }
+ }
+
+ // these were #define macros in the original kiss_fft
+ void C_ADD( cpx_type & c,const cpx_type & a,const cpx_type & b) { c=a+b;}
+ void C_MUL( cpx_type & c,const cpx_type & a,const cpx_type & b) { c=a*b;}
+ void C_SUB( cpx_type & c,const cpx_type & a,const cpx_type & b) { c=a-b;}
+ void C_ADDTO( cpx_type & c,const cpx_type & a) { c+=a;}
+ void C_FIXDIV( cpx_type & ,int ) {} // NO-OP for float types
+ scalar_type S_MUL( const scalar_type & a,const scalar_type & b) { return a*b;}
+ scalar_type HALF_OF( const scalar_type & a) { return a*.5;}
+ void C_MULBYSCALAR(cpx_type & c,const scalar_type & a) {c*=a;}
+
+ void kf_bfly2( cpx_type * Fout, const size_t fstride, int m)
+ {
+ for (int k=0;kreal() - HALF_OF(scratch[3].real() ) , Fout->imag() - HALF_OF(scratch[3].imag() ) );
+
+ C_MULBYSCALAR( scratch[0] , epi3.imag() );
+
+ C_ADDTO(*Fout,scratch[3]);
+
+ Fout[m2] = cpx_type( Fout[m].real() + scratch[0].imag() , Fout[m].imag() - scratch[0].real() );
+
+ C_ADDTO( Fout[m] , cpx_type( -scratch[0].imag(),scratch[0].real() ) );
+ ++Fout;
+ }while(--k);
+ }
+
+ void kf_bfly5( cpx_type * Fout, const size_t fstride, const size_t m)
+ {
+ cpx_type *Fout0,*Fout1,*Fout2,*Fout3,*Fout4;
+ size_t u;
+ cpx_type scratch[13];
+ cpx_type * twiddles = &_twiddles[0];
+ cpx_type *tw;
+ cpx_type ya,yb;
+ ya = twiddles[fstride*m];
+ yb = twiddles[fstride*2*m];
+
+ Fout0=Fout;
+ Fout1=Fout0+m;
+ Fout2=Fout0+2*m;
+ Fout3=Fout0+3*m;
+ Fout4=Fout0+4*m;
+
+ tw=twiddles;
+ for ( u=0; u=Norig) twidx-=Norig;
+ C_MUL(t,scratchbuf[q] , twiddles[twidx] );
+ C_ADDTO( Fout[ k ] ,t);
+ }
+ k += m;
+ }
+ }
+ }
+
+ int _nfft;
+ bool _inverse;
+ std::vector _twiddles;
+ std::vector _stageRadix;
+ std::vector _stageRemainder;
+ traits_type _traits;
+};
+#endif
diff --git a/thirdparty/kiss_fft130/test/Makefile b/thirdparty/kiss_fft130/test/Makefile
new file mode 100644
index 00000000..c204511e
--- /dev/null
+++ b/thirdparty/kiss_fft130/test/Makefile
@@ -0,0 +1,108 @@
+
+WARNINGS=-W -Wall -Wstrict-prototypes -Wmissing-prototypes -Waggregate-return \
+ -Wcast-align -Wcast-qual -Wnested-externs -Wshadow -Wbad-function-cast \
+ -Wwrite-strings
+
+CFLAGS=-O3 -I.. -I../tools $(WARNINGS)
+CFLAGS+=-ffast-math -fomit-frame-pointer
+#CFLAGS+=-funroll-loops
+#CFLAGS+=-march=prescott
+#CFLAGS+= -mtune=native
+# TIP: try adding -openmp or -fopenmp to enable OPENMP directives and use of multiple cores
+#CFLAGS+=-fopenmp
+CFLAGS+= $(CFLAGADD)
+
+
+ifeq "$(NFFT)" ""
+ NFFT=1800
+endif
+ifeq "$(NUMFFTS)" ""
+ NUMFFTS=10000
+endif
+
+ifeq "$(DATATYPE)" ""
+ DATATYPE=float
+endif
+
+BENCHKISS=bm_kiss_$(DATATYPE)
+BENCHFFTW=bm_fftw_$(DATATYPE)
+SELFTEST=st_$(DATATYPE)
+TESTREAL=tr_$(DATATYPE)
+TESTKFC=tkfc_$(DATATYPE)
+FASTFILTREAL=ffr_$(DATATYPE)
+SELFTESTSRC=twotonetest.c
+
+
+TYPEFLAGS=-Dkiss_fft_scalar=$(DATATYPE)
+
+ifeq "$(DATATYPE)" "int16_t"
+ TYPEFLAGS=-DFIXED_POINT=16
+endif
+
+ifeq "$(DATATYPE)" "int32_t"
+ TYPEFLAGS=-DFIXED_POINT=32
+endif
+
+ifeq "$(DATATYPE)" "simd"
+ TYPEFLAGS=-DUSE_SIMD=1 -msse
+endif
+
+
+ifeq "$(DATATYPE)" "float"
+ # fftw needs to be built with --enable-float to build this lib
+ FFTWLIB=-lfftw3f
+else
+ FFTWLIB=-lfftw3
+endif
+
+FFTWLIBDIR=-L/usr/local/lib/
+
+SRCFILES=../kiss_fft.c ../tools/kiss_fftnd.c ../tools/kiss_fftr.c pstats.c ../tools/kfc.c ../tools/kiss_fftndr.c
+
+all: tools $(BENCHKISS) $(SELFTEST) $(BENCHFFTW) $(TESTREAL) $(TESTKFC)
+
+tools:
+ cd ../tools && make all
+
+
+$(SELFTEST): $(SELFTESTSRC) $(SRCFILES)
+ $(CC) -o $@ $(CFLAGS) $(TYPEFLAGS) $+ -lm
+
+$(TESTKFC): $(SRCFILES)
+ $(CC) -o $@ $(CFLAGS) -DKFC_TEST $(TYPEFLAGS) $+ -lm
+
+$(TESTREAL): test_real.c $(SRCFILES)
+ $(CC) -o $@ $(CFLAGS) $(TYPEFLAGS) $+ -lm
+
+$(BENCHKISS): benchkiss.c $(SRCFILES)
+ $(CC) -o $@ $(CFLAGS) $(TYPEFLAGS) $+ -lm
+
+$(BENCHFFTW): benchfftw.c pstats.c
+ @echo "======attempting to build FFTW benchmark"
+ @$(CC) -o $@ $(CFLAGS) -DDATATYPE$(DATATYPE) $+ $(FFTWLIB) $(FFTWLIBDIR) -lm || echo "FFTW not available for comparison"
+
+test: all
+ @./$(TESTKFC)
+ @echo "======1d & 2-d complex fft self test (type= $(DATATYPE) )"
+ @./$(SELFTEST)
+ @echo "======real FFT (type= $(DATATYPE) )"
+ @./$(TESTREAL)
+ @echo "======timing test (type=$(DATATYPE))"
+ @./$(BENCHKISS) -x $(NUMFFTS) -n $(NFFT)
+ @[ -x ./$(BENCHFFTW) ] && ./$(BENCHFFTW) -x $(NUMFFTS) -n $(NFFT) ||true
+ @echo "======higher dimensions type=$(DATATYPE))"
+ @./testkiss.py
+
+selftest.c:
+ ./mk_test.py 10 12 14 > selftest.c
+selftest_short.c:
+ ./mk_test.py -s 10 12 14 > selftest_short.c
+
+
+CXXFLAGS=-O3 -ffast-math -fomit-frame-pointer -I.. -I../tools -W -Wall
+testcpp: testcpp.cc ../kissfft.hh
+ $(CXX) -o $@ $(CXXFLAGS) testcpp.cc -lm
+
+
+clean:
+ rm -f *~ bm_* st_* tr_* kf_* tkfc_* ff_* ffr_* *.pyc *.pyo *.dat testcpp
diff --git a/thirdparty/kiss_fft130/test/benchfftw.c b/thirdparty/kiss_fft130/test/benchfftw.c
new file mode 100644
index 00000000..8824d195
--- /dev/null
+++ b/thirdparty/kiss_fft130/test/benchfftw.c
@@ -0,0 +1,94 @@
+#include
+#include
+#include
+#include
+#include "pstats.h"
+
+#ifdef DATATYPEdouble
+
+#define CPXTYPE fftw_complex
+#define PLAN fftw_plan
+#define FFTMALLOC fftw_malloc
+#define MAKEPLAN fftw_plan_dft_1d
+#define DOFFT fftw_execute
+#define DESTROYPLAN fftw_destroy_plan
+#define FFTFREE fftw_free
+
+#elif defined(DATATYPEfloat)
+
+#define CPXTYPE fftwf_complex
+#define PLAN fftwf_plan
+#define FFTMALLOC fftwf_malloc
+#define MAKEPLAN fftwf_plan_dft_1d
+#define DOFFT fftwf_execute
+#define DESTROYPLAN fftwf_destroy_plan
+#define FFTFREE fftwf_free
+
+#endif
+
+#ifndef CPXTYPE
+int main(void)
+{
+ fprintf(stderr,"Datatype not available in FFTW\n" );
+ return 0;
+}
+#else
+int main(int argc,char ** argv)
+{
+ int nfft=1024;
+ int isinverse=0;
+ int numffts=1000,i;
+
+ CPXTYPE * in=NULL;
+ CPXTYPE * out=NULL;
+ PLAN p;
+
+ pstats_init();
+
+ while (1) {
+ int c = getopt (argc, argv, "n:ix:h");
+ if (c == -1)
+ break;
+ switch (c) {
+ case 'n':
+ nfft = atoi (optarg);
+ break;
+ case 'x':
+ numffts = atoi (optarg);
+ break;
+ case 'i':
+ isinverse = 1;
+ break;
+ case 'h':
+ case '?':
+ default:
+ fprintf(stderr,"options:\n-n N: complex fft length\n-i: inverse\n-x N: number of ffts to compute\n"
+ "");
+ }
+ }
+
+ in=FFTMALLOC(sizeof(CPXTYPE) * nfft);
+ out=FFTMALLOC(sizeof(CPXTYPE) * nfft);
+ for (i=0;i
+#include
+#include
+#include
+#include "kiss_fft.h"
+#include "kiss_fftr.h"
+#include "kiss_fftnd.h"
+#include "kiss_fftndr.h"
+
+#include "pstats.h"
+
+static
+int getdims(int * dims, char * arg)
+{
+ char *s;
+ int ndims=0;
+ while ( (s=strtok( arg , ",") ) ) {
+ dims[ndims++] = atoi(s);
+ //printf("%s=%d\n",s,dims[ndims-1]);
+ arg=NULL;
+ }
+ return ndims;
+}
+
+int main(int argc,char ** argv)
+{
+ int k;
+ int nfft[32];
+ int ndims = 1;
+ int isinverse=0;
+ int numffts=1000,i;
+ kiss_fft_cpx * buf;
+ kiss_fft_cpx * bufout;
+ int real = 0;
+
+ nfft[0] = 1024;// default
+
+ while (1) {
+ int c = getopt (argc, argv, "n:ix:r");
+ if (c == -1)
+ break;
+ switch (c) {
+ case 'r':
+ real = 1;
+ break;
+ case 'n':
+ ndims = getdims(nfft, optarg );
+ if (nfft[0] != kiss_fft_next_fast_size(nfft[0]) ) {
+ int ng = kiss_fft_next_fast_size(nfft[0]);
+ fprintf(stderr,"warning: %d might be a better choice for speed than %d\n",ng,nfft[0]);
+ }
+ break;
+ case 'x':
+ numffts = atoi (optarg);
+ break;
+ case 'i':
+ isinverse = 1;
+ break;
+ }
+ }
+ int nbytes = sizeof(kiss_fft_cpx);
+ for (k=0;k
+
+#include "kiss_fft.h"
+#include "kiss_fftnd.h"
+#include "kiss_fftr.h"
+
+BEGIN_BENCH_DOC
+BENCH_DOC("name", "kissfft")
+BENCH_DOC("version", "1.0.1")
+BENCH_DOC("year", "2004")
+BENCH_DOC("author", "Mark Borgerding")
+BENCH_DOC("language", "C")
+BENCH_DOC("url", "http://sourceforge.net/projects/kissfft/")
+BENCH_DOC("copyright",
+"Copyright (c) 2003,4 Mark Borgerding\n"
+"\n"
+"All rights reserved.\n"
+"\n"
+"Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:\n"
+"\n"
+" * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.\n"
+" * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution.\n"
+" * Neither the author nor the names of any contributors may be used to endorse or promote products derived from this software without specific prior written permission.\n"
+"\n"
+ "THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS \"AS IS\" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.\n")
+END_BENCH_DOC
+
+int can_do(struct problem *p)
+{
+ if (p->rank == 1) {
+ if (p->kind == PROBLEM_REAL) {
+ return (p->n[0] & 1) == 0; /* only even real is okay */
+ } else {
+ return 1;
+ }
+ } else {
+ return p->kind == PROBLEM_COMPLEX;
+ }
+}
+
+static kiss_fft_cfg cfg=NULL;
+static kiss_fftr_cfg cfgr=NULL;
+static kiss_fftnd_cfg cfgnd=NULL;
+
+#define FAILIF( c ) \
+ if ( c ) do {\
+ fprintf(stderr,\
+ "kissfft: " #c " (file=%s:%d errno=%d %s)\n",\
+ __FILE__,__LINE__ , errno,strerror( errno ) ) ;\
+ exit(1);\
+ }while(0)
+
+
+
+void setup(struct problem *p)
+{
+ size_t i;
+
+ /*
+ fprintf(stderr,"%s %s %d-d ",
+ (p->sign == 1)?"Inverse":"Forward",
+ p->kind == PROBLEM_COMPLEX?"Complex":"Real",
+ p->rank);
+ */
+ if (p->rank == 1) {
+ if (p->kind == PROBLEM_COMPLEX) {
+ cfg = kiss_fft_alloc (p->n[0], (p->sign == 1), 0, 0);
+ FAILIF(cfg==NULL);
+ }else{
+ cfgr = kiss_fftr_alloc (p->n[0], (p->sign == 1), 0, 0);
+ FAILIF(cfgr==NULL);
+ }
+ }else{
+ int dims[5];
+ for (i=0;irank;++i){
+ dims[i] = p->n[i];
+ }
+ /* multi-dimensional */
+ if (p->kind == PROBLEM_COMPLEX) {
+ cfgnd = kiss_fftnd_alloc( dims , p->rank, (p->sign == 1), 0, 0 );
+ FAILIF(cfgnd==NULL);
+ }
+ }
+}
+
+void doit(int iter, struct problem *p)
+{
+ int i;
+ void *in = p->in;
+ void *out = p->out;
+
+ if (p->in_place)
+ out = p->in;
+
+ if (p->rank == 1) {
+ if (p->kind == PROBLEM_COMPLEX){
+ for (i = 0; i < iter; ++i)
+ kiss_fft (cfg, in, out);
+ } else {
+ /* PROBLEM_REAL */
+ if (p->sign == -1) /* FORWARD */
+ for (i = 0; i < iter; ++i)
+ kiss_fftr (cfgr, in, out);
+ else
+ for (i = 0; i < iter; ++i)
+ kiss_fftri (cfgr, in, out);
+ }
+ }else{
+ /* multi-dimensional */
+ for (i = 0; i < iter; ++i)
+ kiss_fftnd(cfgnd,in,out);
+ }
+}
+
+void done(struct problem *p)
+{
+ free(cfg);
+ cfg=NULL;
+ free(cfgr);
+ cfgr=NULL;
+ free(cfgnd);
+ cfgnd=NULL;
+ UNUSED(p);
+}
diff --git a/thirdparty/kiss_fft130/test/fastfir.py b/thirdparty/kiss_fft130/test/fastfir.py
new file mode 100644
index 00000000..5ff432a3
--- /dev/null
+++ b/thirdparty/kiss_fft130/test/fastfir.py
@@ -0,0 +1,102 @@
+#!/usr/bin/env python
+
+from Numeric import *
+from FFT import *
+
+def make_random(len):
+ import random
+ res=[]
+ for i in range(int(len)):
+ r=random.uniform(-1,1)
+ i=random.uniform(-1,1)
+ res.append( complex(r,i) )
+ return res
+
+def slowfilter(sig,h):
+ translen = len(h)-1
+ return convolve(sig,h)[translen:-translen]
+
+def nextpow2(x):
+ return 2 ** math.ceil(math.log(x)/math.log(2))
+
+def fastfilter(sig,h,nfft=None):
+ if nfft is None:
+ nfft = int( nextpow2( 2*len(h) ) )
+ H = fft( h , nfft )
+ scraplen = len(h)-1
+ keeplen = nfft-scraplen
+ res=[]
+ isdone = 0
+ lastidx = nfft
+ idx0 = 0
+ while not isdone:
+ idx1 = idx0 + nfft
+ if idx1 >= len(sig):
+ idx1 = len(sig)
+ lastidx = idx1-idx0
+ if lastidx <= scraplen:
+ break
+ isdone = 1
+ Fss = fft(sig[idx0:idx1],nfft)
+ fm = Fss * H
+ m = inverse_fft(fm)
+ res.append( m[scraplen:lastidx] )
+ idx0 += keeplen
+ return concatenate( res )
+
+def main():
+ import sys
+ from getopt import getopt
+ opts,args = getopt(sys.argv[1:],'rn:l:')
+ opts=dict(opts)
+
+ siglen = int(opts.get('-l',1e4 ) )
+ hlen =50
+
+ nfft = int(opts.get('-n',128) )
+ usereal = opts.has_key('-r')
+
+ print 'nfft=%d'%nfft
+ # make a signal
+ sig = make_random( siglen )
+ # make an impulse response
+ h = make_random( hlen )
+ #h=[1]*2+[0]*3
+ if usereal:
+ sig=[c.real for c in sig]
+ h=[c.real for c in h]
+
+ # perform MAC filtering
+ yslow = slowfilter(sig,h)
+ #print '',yslow,''
+ #yfast = fastfilter(sig,h,nfft)
+ yfast = utilfastfilter(sig,h,nfft,usereal)
+ #print yfast
+ print 'len(yslow)=%d'%len(yslow)
+ print 'len(yfast)=%d'%len(yfast)
+ diff = yslow-yfast
+ snr = 10*log10( abs( vdot(yslow,yslow) / vdot(diff,diff) ) )
+ print 'snr=%s' % snr
+ if snr < 10.0:
+ print 'h=',h
+ print 'sig=',sig[:5],'...'
+ print 'yslow=',yslow[:5],'...'
+ print 'yfast=',yfast[:5],'...'
+
+def utilfastfilter(sig,h,nfft,usereal):
+ import compfft
+ import os
+ open( 'sig.dat','w').write( compfft.dopack(sig,'f',not usereal) )
+ open( 'h.dat','w').write( compfft.dopack(h,'f',not usereal) )
+ if usereal:
+ util = './fastconvr'
+ else:
+ util = './fastconv'
+ cmd = 'time %s -n %d -i sig.dat -h h.dat -o out.dat' % (util, nfft)
+ print cmd
+ ec = os.system(cmd)
+ print 'exited->',ec
+ return compfft.dounpack(open('out.dat').read(),'f',not usereal)
+
+if __name__ == "__main__":
+ main()
diff --git a/thirdparty/kiss_fft130/test/fft.py b/thirdparty/kiss_fft130/test/fft.py
new file mode 100644
index 00000000..2705f71f
--- /dev/null
+++ b/thirdparty/kiss_fft130/test/fft.py
@@ -0,0 +1,196 @@
+#!/usr/bin/env python
+
+import math
+import sys
+import random
+
+pi=math.pi
+e=math.e
+j=complex(0,1)
+
+def fft(f,inv):
+ n=len(f)
+ if n==1:
+ return f
+
+ for p in 2,3,5:
+ if n%p==0:
+ break
+ else:
+ raise Exception('%s not factorable ' % n)
+
+ m = n/p
+ Fout=[]
+ for q in range(p): # 0,1
+ fp = f[q::p] # every p'th time sample
+ Fp = fft( fp ,inv)
+ Fout.extend( Fp )
+
+ for u in range(m):
+ scratch = Fout[u::m] # u to end in strides of m
+ for q1 in range(p):
+ k = q1*m + u # indices to Fout above that became scratch
+ Fout[ k ] = scratch[0] # cuz e**0==1 in loop below
+ for q in range(1,p):
+ if inv:
+ t = e ** ( j*2*pi*k*q/n )
+ else:
+ t = e ** ( -j*2*pi*k*q/n )
+ Fout[ k ] += scratch[q] * t
+
+ return Fout
+
+def rifft(F):
+ N = len(F) - 1
+ Z = [0] * (N)
+ for k in range(N):
+ Fek = ( F[k] + F[-k-1].conjugate() )
+ Fok = ( F[k] - F[-k-1].conjugate() ) * e ** (j*pi*k/N)
+ Z[k] = Fek + j*Fok
+
+ fp = fft(Z , 1)
+
+ f = []
+ for c in fp:
+ f.append(c.real)
+ f.append(c.imag)
+ return f
+
+def real_fft( f,inv ):
+ if inv:
+ return rifft(f)
+
+ N = len(f) / 2
+
+ res = f[::2]
+ ims = f[1::2]
+
+ fp = [ complex(r,i) for r,i in zip(res,ims) ]
+ print 'fft input ', fp
+ Fp = fft( fp ,0 )
+ print 'fft output ', Fp
+
+ F = [ complex(0,0) ] * ( N+1 )
+
+ F[0] = complex( Fp[0].real + Fp[0].imag , 0 )
+
+ for k in range(1,N/2+1):
+ tw = e ** ( -j*pi*(.5+float(k)/N ) )
+
+ F1k = Fp[k] + Fp[N-k].conjugate()
+ F2k = Fp[k] - Fp[N-k].conjugate()
+ F2k *= tw
+ F[k] = ( F1k + F2k ) * .5
+ F[N-k] = ( F1k - F2k ).conjugate() * .5
+ #F[N-k] = ( F1kp + e ** ( -j*pi*(.5+float(N-k)/N ) ) * F2kp ) * .5
+ #F[N-k] = ( F1k.conjugate() - tw.conjugate() * F2k.conjugate() ) * .5
+
+ F[N] = complex( Fp[0].real - Fp[0].imag , 0 )
+ return F
+
+def main():
+ #fft_func = fft
+ fft_func = real_fft
+
+ tvec = [0.309655,0.815653,0.768570,0.591841,0.404767,0.637617,0.007803,0.012665]
+ Ftvec = [ complex(r,i) for r,i in zip(
+ [3.548571,-0.378761,-0.061950,0.188537,-0.566981,0.188537,-0.061950,-0.378761],
+ [0.000000,-1.296198,-0.848764,0.225337,0.000000,-0.225337,0.848764,1.296198] ) ]
+
+ F = fft_func( tvec,0 )
+
+ nerrs= 0
+ for i in range(len(Ftvec)/2 + 1):
+ if abs( F[i] - Ftvec[i] )> 1e-5:
+ print 'F[%d]: %s != %s' % (i,F[i],Ftvec[i])
+ nerrs += 1
+
+ print '%d errors in forward fft' % nerrs
+ if nerrs:
+ return
+
+ trec = fft_func( F , 1 )
+
+ for i in range(len(trec) ):
+ trec[i] /= len(trec)
+
+ for i in range(len(tvec) ):
+ if abs( trec[i] - tvec[i] )> 1e-5:
+ print 't[%d]: %s != %s' % (i,tvec[i],trec[i])
+ nerrs += 1
+
+ print '%d errors in reverse fft' % nerrs
+
+
+def make_random(dims=[1]):
+ import Numeric
+ res = []
+ for i in range(dims[0]):
+ if len(dims)==1:
+ r=random.uniform(-1,1)
+ i=random.uniform(-1,1)
+ res.append( complex(r,i) )
+ else:
+ res.append( make_random( dims[1:] ) )
+ return Numeric.array(res)
+
+def flatten(x):
+ import Numeric
+ ntotal = Numeric.product(Numeric.shape(x))
+ return Numeric.reshape(x,(ntotal,))
+
+def randmat( ndims ):
+ dims=[]
+ for i in range( ndims ):
+ curdim = int( random.uniform(2,4) )
+ dims.append( curdim )
+ return make_random(dims )
+
+def test_fftnd(ndims=3):
+ import FFT
+ import Numeric
+
+ x=randmat( ndims )
+ print 'dimensions=%s' % str( Numeric.shape(x) )
+ #print 'x=%s' %str(x)
+ xver = FFT.fftnd(x)
+ x2=myfftnd(x)
+ err = xver - x2
+ errf = flatten(err)
+ xverf = flatten(xver)
+ errpow = Numeric.vdot(errf,errf)+1e-10
+ sigpow = Numeric.vdot(xverf,xverf)+1e-10
+ snr = 10*math.log10(abs(sigpow/errpow) )
+ if snr<80:
+ print xver
+ print x2
+ print 'SNR=%sdB' % str( snr )
+
+def myfftnd(x):
+ import Numeric
+ xf = flatten(x)
+ Xf = fftndwork( xf , Numeric.shape(x) )
+ return Numeric.reshape(Xf,Numeric.shape(x) )
+
+def fftndwork(x,dims):
+ import Numeric
+ dimprod=Numeric.product( dims )
+
+ for k in range( len(dims) ):
+ cur_dim=dims[ k ]
+ stride=dimprod/cur_dim
+ next_x = [complex(0,0)]*len(x)
+ for i in range(stride):
+ next_x[i*cur_dim:(i+1)*cur_dim] = fft(x[i:(i+cur_dim)*stride:stride],0)
+ x = next_x
+ return x
+
+if __name__ == "__main__":
+ try:
+ nd = int(sys.argv[1])
+ except:
+ nd=None
+ if nd:
+ test_fftnd( nd )
+ else:
+ sys.exit(0)
diff --git a/thirdparty/kiss_fft130/test/mk_test.py b/thirdparty/kiss_fft130/test/mk_test.py
new file mode 100644
index 00000000..998b730f
--- /dev/null
+++ b/thirdparty/kiss_fft130/test/mk_test.py
@@ -0,0 +1,117 @@
+#!/usr/bin/env python
+
+import FFT
+import sys
+import random
+import re
+j=complex(0,1)
+
+def randvec(n,iscomplex):
+ if iscomplex:
+ return [
+ int(random.uniform(-32768,32767) ) + j*int(random.uniform(-32768,32767) )
+ for i in range(n) ]
+ else:
+ return [ int(random.uniform(-32768,32767) ) for i in range(n) ]
+
+def c_format(v,round=0):
+ if round:
+ return ','.join( [ '{%d,%d}' %(int(c.real),int(c.imag) ) for c in v ] )
+ else:
+ s= ','.join( [ '{%.60f ,%.60f }' %(c.real,c.imag) for c in v ] )
+ return re.sub(r'\.?0+ ',' ',s)
+
+def test_cpx( n,inverse ,short):
+ v = randvec(n,1)
+ scale = 1
+ if short:
+ minsnr=30
+ else:
+ minsnr=100
+
+ if inverse:
+ tvecout = FFT.inverse_fft(v)
+ if short:
+ scale = 1
+ else:
+ scale = len(v)
+ else:
+ tvecout = FFT.fft(v)
+ if short:
+ scale = 1.0/len(v)
+
+ tvecout = [ c * scale for c in tvecout ]
+
+
+ s="""#define NFFT %d""" % len(v) + """
+ {
+ double snr;
+ kiss_fft_cpx test_vec_in[NFFT] = { """ + c_format(v) + """};
+ kiss_fft_cpx test_vec_out[NFFT] = {""" + c_format( tvecout ) + """};
+ kiss_fft_cpx testbuf[NFFT];
+ void * cfg = kiss_fft_alloc(NFFT,%d,0,0);""" % inverse + """
+
+ kiss_fft(cfg,test_vec_in,testbuf);
+ snr = snr_compare(test_vec_out,testbuf,NFFT);
+ printf("DATATYPE=" xstr(kiss_fft_scalar) ", FFT n=%d, inverse=%d, snr = %g dB\\n",NFFT,""" + str(inverse) + """,snr);
+ if (snr<""" + str(minsnr) + """)
+ exit_code++;
+ free(cfg);
+ }
+#undef NFFT
+"""
+ return s
+
+def compare_func():
+ s="""
+#define xstr(s) str(s)
+#define str(s) #s
+double snr_compare( kiss_fft_cpx * test_vec_out,kiss_fft_cpx * testbuf, int n)
+{
+ int k;
+ double sigpow,noisepow,err,snr,scale=0;
+ kiss_fft_cpx err;
+ sigpow = noisepow = .000000000000000000000000000001;
+
+ for (k=0;k
+#include
+#include
+#include
+#include
+
+#include "pstats.h"
+
+static struct tms tms_beg;
+static struct tms tms_end;
+static int has_times = 0;
+
+
+void pstats_init(void)
+{
+ has_times = times(&tms_beg) != -1;
+}
+
+static void tms_report(void)
+{
+ double cputime;
+ if (! has_times )
+ return;
+ times(&tms_end);
+ cputime = ( ((float)tms_end.tms_utime + tms_end.tms_stime + tms_end.tms_cutime + tms_end.tms_cstime ) -
+ ((float)tms_beg.tms_utime + tms_beg.tms_stime + tms_beg.tms_cutime + tms_beg.tms_cstime ) )
+ / sysconf(_SC_CLK_TCK);
+ fprintf(stderr,"\tcputime=%.3f\n" , cputime);
+}
+
+static void ps_report(void)
+{
+ char buf[1024];
+#ifdef __APPLE__ /* MAC OS X */
+ sprintf(buf,"ps -o command,majflt,minflt,rss,pagein,vsz -p %d 1>&2",getpid() );
+#else /* GNU/Linux */
+ sprintf(buf,"ps -o comm,majflt,minflt,rss,drs,pagein,sz,trs,vsz %d 1>&2",getpid() );
+#endif
+ if (system( buf )==-1) {
+ perror("system call to ps failed");
+ }
+}
+
+void pstats_report()
+{
+ ps_report();
+ tms_report();
+}
+
diff --git a/thirdparty/kiss_fft130/test/pstats.h b/thirdparty/kiss_fft130/test/pstats.h
new file mode 100644
index 00000000..71ff02a4
--- /dev/null
+++ b/thirdparty/kiss_fft130/test/pstats.h
@@ -0,0 +1,7 @@
+#ifndef PSTATS_H
+#define PSTATS_H
+
+void pstats_init(void);
+void pstats_report(void);
+
+#endif
diff --git a/thirdparty/kiss_fft130/test/tailscrap.m b/thirdparty/kiss_fft130/test/tailscrap.m
new file mode 100644
index 00000000..abf90469
--- /dev/null
+++ b/thirdparty/kiss_fft130/test/tailscrap.m
@@ -0,0 +1,26 @@
+function maxabsdiff=tailscrap()
+% test code for circular convolution with the scrapped portion
+% at the tail of the buffer, rather than the front
+%
+% The idea is to rotate the zero-padded h (impulse response) buffer
+% to the left nh-1 samples, rotating the junk samples as well.
+% This could be very handy in avoiding buffer copies during fast filtering.
+nh=10;
+nfft=256;
+
+h=rand(1,nh);
+x=rand(1,nfft);
+
+hpad=[ h(nh) zeros(1,nfft-nh) h(1:nh-1) ];
+
+% baseline comparison
+y1 = filter(h,1,x);
+y1_notrans = y1(nh:nfft);
+
+% fast convolution
+y2 = ifft( fft(hpad) .* fft(x) );
+y2_notrans=y2(1:nfft-nh+1);
+
+maxabsdiff = max(abs(y2_notrans - y1_notrans))
+
+end
diff --git a/thirdparty/kiss_fft130/test/test_real.c b/thirdparty/kiss_fft130/test/test_real.c
new file mode 100644
index 00000000..36a0b086
--- /dev/null
+++ b/thirdparty/kiss_fft130/test/test_real.c
@@ -0,0 +1,172 @@
+#include "kiss_fftr.h"
+#include "_kiss_fft_guts.h"
+#include
+#include
+#include
+
+static double cputime(void)
+{
+ struct tms t;
+ times(&t);
+ return (double)(t.tms_utime + t.tms_stime)/ sysconf(_SC_CLK_TCK) ;
+}
+
+static
+kiss_fft_scalar rand_scalar(void)
+{
+#ifdef USE_SIMD
+ return _mm_set1_ps(rand()-RAND_MAX/2);
+#else
+ kiss_fft_scalar s = (kiss_fft_scalar)(rand() -RAND_MAX/2);
+ return s/2;
+#endif
+}
+
+static
+double snr_compare( kiss_fft_cpx * vec1,kiss_fft_cpx * vec2, int n)
+{
+ int k;
+ double sigpow=1e-10,noisepow=1e-10,err,snr,scale=0;
+
+#ifdef USE_SIMD
+ float *fv1 = (float*)vec1;
+ float *fv2 = (float*)vec2;
+ for (k=0;k<8*n;++k) {
+ sigpow += *fv1 * *fv1;
+ err = *fv1 - *fv2;
+ noisepow += err*err;
+ ++fv1;
+ ++fv2;
+ }
+#else
+ for (k=0;k1)
+ nfft = atoi(argv[1]);
+ kiss_fft_cpx cin[nfft];
+ kiss_fft_cpx cout[nfft];
+ kiss_fft_cpx sout[nfft];
+ kiss_fft_cfg kiss_fft_state;
+ kiss_fftr_cfg kiss_fftr_state;
+
+ kiss_fft_scalar rin[nfft+2];
+ kiss_fft_scalar rout[nfft+2];
+ kiss_fft_scalar zero;
+ memset(&zero,0,sizeof(zero) ); // ugly way of setting short,int,float,double, or __m128 to zero
+
+ srand(time(0));
+
+ for (i=0;i1) {
+ int k;
+ for (k=1;k
+#include
+#include
+
+#include
+static inline
+double curtime(void)
+{
+ struct timeval tv;
+ gettimeofday(&tv, NULL);
+ return (double)tv.tv_sec + (double)tv.tv_usec*.000001;
+}
+
+using namespace std;
+
+template
+void dotest(int nfft)
+{
+ typedef kissfft FFT;
+ typedef std::complex cpx_type;
+
+ cout << "type:" << typeid(T).name() << " nfft:" << nfft;
+
+ FFT fft(nfft,false);
+
+ vector inbuf(nfft);
+ vector outbuf(nfft);
+ for (int k=0;k acc = 0;
+ long double phinc = 2*k0* M_PIl / nfft;
+ for (int k1=0;k1 x(inbuf[k1].real(),inbuf[k1].imag());
+ acc += x * exp( complex(0,-k1*phinc) );
+ }
+ totalpower += norm(acc);
+ complex x(outbuf[k0].real(),outbuf[k0].imag());
+ complex dif = acc - x;
+ difpower += norm(dif);
+ }
+ cout << " RMSE:" << sqrt(difpower/totalpower) << "\t";
+
+ double t0 = curtime();
+ int nits=20e6/nfft;
+ for (int k=0;k1) {
+ for (int k=1;k(nfft); dotest(nfft); dotest(nfft);
+ }
+ }else{
+ dotest(32); dotest(32); dotest(32);
+ dotest(1024); dotest(1024); dotest(1024);
+ dotest(840); dotest(840); dotest(840);
+ }
+ return 0;
+}
diff --git a/thirdparty/kiss_fft130/test/testkiss.py b/thirdparty/kiss_fft130/test/testkiss.py
new file mode 100644
index 00000000..af750654
--- /dev/null
+++ b/thirdparty/kiss_fft130/test/testkiss.py
@@ -0,0 +1,162 @@
+#!/usr/bin/env python
+
+import math
+import sys
+import os
+import random
+import struct
+import popen2
+import getopt
+import numpy
+
+pi=math.pi
+e=math.e
+j=complex(0,1)
+
+doreal=0
+
+datatype = os.environ.get('DATATYPE','float')
+
+util = '../tools/fft_' + datatype
+minsnr=90
+if datatype == 'double':
+ fmt='d'
+elif datatype=='int16_t':
+ fmt='h'
+ minsnr=10
+elif datatype=='int32_t':
+ fmt='i'
+elif datatype=='simd':
+ fmt='4f'
+ sys.stderr.write('testkiss.py does not yet test simd')
+ sys.exit(0)
+elif datatype=='float':
+ fmt='f'
+else:
+ sys.stderr.write('unrecognized datatype %s\n' % datatype)
+ sys.exit(1)
+
+
+def dopack(x,cpx=1):
+ x = numpy.reshape( x, ( numpy.size(x),) )
+
+ if cpx:
+ s = ''.join( [ struct.pack(fmt*2,c.real,c.imag) for c in x ] )
+ else:
+ s = ''.join( [ struct.pack(fmt,c.real) for c in x ] )
+ return s
+
+def dounpack(x,cpx):
+ uf = fmt * ( len(x) / struct.calcsize(fmt) )
+ s = struct.unpack(uf,x)
+ if cpx:
+ return numpy.array(s[::2]) + numpy.array( s[1::2] )*j
+ else:
+ return numpy.array(s )
+
+def make_random(dims=[1]):
+ res = []
+ for i in range(dims[0]):
+ if len(dims)==1:
+ r=random.uniform(-1,1)
+ if doreal:
+ res.append( r )
+ else:
+ i=random.uniform(-1,1)
+ res.append( complex(r,i) )
+ else:
+ res.append( make_random( dims[1:] ) )
+ return numpy.array(res)
+
+def flatten(x):
+ ntotal = numpy.size(x)
+ return numpy.reshape(x,(ntotal,))
+
+def randmat( ndims ):
+ dims=[]
+ for i in range( ndims ):
+ curdim = int( random.uniform(2,5) )
+ if doreal and i==(ndims-1):
+ curdim = int(curdim/2)*2 # force even last dimension if real
+ dims.append( curdim )
+ return make_random(dims )
+
+def test_fft(ndims):
+ x=randmat( ndims )
+
+
+ if doreal:
+ xver = numpy.fft.rfftn(x)
+ else:
+ xver = numpy.fft.fftn(x)
+
+ open('/tmp/fftexp.dat','w').write(dopack( flatten(xver) , True ) )
+
+ x2=dofft(x,doreal)
+ err = xver - x2
+ errf = flatten(err)
+ xverf = flatten(xver)
+ errpow = numpy.vdot(errf,errf)+1e-10
+ sigpow = numpy.vdot(xverf,xverf)+1e-10
+ snr = 10*math.log10(abs(sigpow/errpow) )
+ print 'SNR (compared to NumPy) : %.1fdB' % float(snr)
+
+ if snr
+#include
+#include
+#include "kiss_fft.h"
+#include "kiss_fftr.h"
+#include
+
+
+static
+double two_tone_test( int nfft, int bin1,int bin2)
+{
+ kiss_fftr_cfg cfg = NULL;
+ kiss_fft_cpx *kout = NULL;
+ kiss_fft_scalar *tbuf = NULL;
+
+ int i;
+ double f1 = bin1*2*M_PI/nfft;
+ double f2 = bin2*2*M_PI/nfft;
+ double sigpow=0;
+ double noisepow=0;
+#if FIXED_POINT==32
+ long maxrange = LONG_MAX;
+#else
+ long maxrange = SHRT_MAX;/* works fine for float too*/
+#endif
+
+ cfg = kiss_fftr_alloc(nfft , 0, NULL, NULL);
+ tbuf = KISS_FFT_MALLOC(nfft * sizeof(kiss_fft_scalar));
+ kout = KISS_FFT_MALLOC(nfft * sizeof(kiss_fft_cpx));
+
+ /* generate a signal with two tones*/
+ for (i = 0; i < nfft; i++) {
+#ifdef USE_SIMD
+ tbuf[i] = _mm_set1_ps( (maxrange>>1)*cos(f1*i)
+ + (maxrange>>1)*cos(f2*i) );
+#else
+ tbuf[i] = (maxrange>>1)*cos(f1*i)
+ + (maxrange>>1)*cos(f2*i);
+#endif
+ }
+
+ kiss_fftr(cfg, tbuf, kout);
+
+ for (i=0;i < (nfft/2+1);++i) {
+#ifdef USE_SIMD
+ double tmpr = (double)*(float*)&kout[i].r / (double)maxrange;
+ double tmpi = (double)*(float*)&kout[i].i / (double)maxrange;
+#else
+ double tmpr = (double)kout[i].r / (double)maxrange;
+ double tmpi = (double)kout[i].i / (double)maxrange;
+#endif
+ double mag2 = tmpr*tmpr + tmpi*tmpi;
+ if (i!=0 && i!= nfft/2)
+ mag2 *= 2; /* all bins except DC and Nyquist have symmetric counterparts implied*/
+
+ /* if there is power in one of the expected bins, it is signal, otherwise noise*/
+ if ( i!=bin1 && i != bin2 )
+ noisepow += mag2;
+ else
+ sigpow += mag2;
+ }
+ kiss_fft_cleanup();
+ /*printf("TEST %d,%d,%d noise @ %fdB\n",nfft,bin1,bin2,10*log10(noisepow/sigpow +1e-30) );*/
+ return 10*log10(sigpow/(noisepow+1e-50) );
+}
+
+int main(int argc,char ** argv)
+{
+ int nfft = 4*2*2*3*5;
+ if (argc>1) nfft = atoi(argv[1]);
+
+ int i,j;
+ double minsnr = 500;
+ double maxsnr = -500;
+ double snr;
+ for (i=0;i>4)+1) {
+ for (j=i;j>4)+7) {
+ snr = two_tone_test(nfft,i,j);
+ if (snrmaxsnr) {
+ maxsnr=snr;
+ }
+ }
+ }
+ snr = two_tone_test(nfft,nfft/2,nfft/2);
+ if (snrmaxsnr) maxsnr=snr;
+
+ printf("TwoToneTest: snr ranges from %ddB to %ddB\n",(int)minsnr,(int)maxsnr);
+ printf("sizeof(kiss_fft_scalar) = %d\n",(int)sizeof(kiss_fft_scalar) );
+ return 0;
+}
diff --git a/thirdparty/kiss_fft130/tools/Makefile b/thirdparty/kiss_fft130/tools/Makefile
new file mode 100644
index 00000000..ae7646b8
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/Makefile
@@ -0,0 +1,62 @@
+WARNINGS=-W -Wall -Wstrict-prototypes -Wmissing-prototypes -Waggregate-return \
+ -Wcast-align -Wcast-qual -Wnested-externs -Wshadow -Wbad-function-cast \
+ -Wwrite-strings
+
+ifeq "$(DATATYPE)" ""
+ DATATYPE=float
+endif
+
+ifeq "$(DATATYPE)" "int32_t"
+ TYPEFLAGS=-DFIXED_POINT=32
+endif
+
+ifeq "$(DATATYPE)" "int16_t"
+ TYPEFLAGS=-DFIXED_POINT=16
+endif
+
+ifeq "$(DATATYPE)" "simd"
+ TYPEFLAGS=-DUSE_SIMD=1 -msse
+endif
+
+ifeq "$(TYPEFLAGS)" ""
+ TYPEFLAGS=-Dkiss_fft_scalar=$(DATATYPE)
+endif
+
+ifneq ("$(KISS_FFT_USE_ALLOCA)","")
+ CFLAGS+= -DKISS_FFT_USE_ALLOCA=1
+endif
+CFLAGS+= $(CFLAGADD)
+
+
+FFTUTIL=fft_$(DATATYPE)
+FASTFILT=fastconv_$(DATATYPE)
+FASTFILTREAL=fastconvr_$(DATATYPE)
+PSDPNG=psdpng_$(DATATYPE)
+DUMPHDR=dumphdr_$(DATATYPE)
+
+all: $(FFTUTIL) $(FASTFILT) $(FASTFILTREAL)
+# $(PSDPNG)
+# $(DUMPHDR)
+
+#CFLAGS=-Wall -O3 -pedantic -march=pentiumpro -ffast-math -fomit-frame-pointer $(WARNINGS)
+# If the above flags do not work, try the following
+CFLAGS=-Wall -O3 $(WARNINGS)
+# tip: try -openmp or -fopenmp to use multiple cores
+
+$(FASTFILTREAL): ../kiss_fft.c kiss_fastfir.c kiss_fftr.c
+ $(CC) -o $@ $(CFLAGS) -I.. $(TYPEFLAGS) -DREAL_FASTFIR $+ -DFAST_FILT_UTIL -lm
+
+$(FASTFILT): ../kiss_fft.c kiss_fastfir.c
+ $(CC) -o $@ $(CFLAGS) -I.. $(TYPEFLAGS) $+ -DFAST_FILT_UTIL -lm
+
+$(FFTUTIL): ../kiss_fft.c fftutil.c kiss_fftnd.c kiss_fftr.c kiss_fftndr.c
+ $(CC) -o $@ $(CFLAGS) -I.. $(TYPEFLAGS) $+ -lm
+
+$(PSDPNG): ../kiss_fft.c psdpng.c kiss_fftr.c
+ $(CC) -o $@ $(CFLAGS) -I.. $(TYPEFLAGS) $+ -lpng -lm
+
+$(DUMPHDR): ../kiss_fft.c dumphdr.c
+ $(CC) -o $@ $(CFLAGS) -I.. $(TYPEFLAGS) $+ -lm
+
+clean:
+ rm -f *~ fft fft_* fastconv fastconv_* fastconvr fastconvr_* psdpng psdpng_*
diff --git a/thirdparty/kiss_fft130/tools/fftutil.c b/thirdparty/kiss_fft130/tools/fftutil.c
new file mode 100644
index 00000000..db5a8151
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/fftutil.c
@@ -0,0 +1,208 @@
+/*
+Copyright (c) 2003-2004, Mark Borgerding
+
+All rights reserved.
+
+Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:
+
+ * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
+ * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution.
+ * Neither the author nor the names of any contributors may be used to endorse or promote products derived from this software without specific prior written permission.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#include
+#include
+#include
+#include
+#include
+
+#include "kiss_fft.h"
+#include "kiss_fftndr.h"
+
+static
+void fft_file(FILE * fin,FILE * fout,int nfft,int isinverse)
+{
+ kiss_fft_cfg st;
+ kiss_fft_cpx * buf;
+ kiss_fft_cpx * bufout;
+
+ buf = (kiss_fft_cpx*)malloc(sizeof(kiss_fft_cpx) * nfft );
+ bufout = (kiss_fft_cpx*)malloc(sizeof(kiss_fft_cpx) * nfft );
+ st = kiss_fft_alloc( nfft ,isinverse ,0,0);
+
+ while ( fread( buf , sizeof(kiss_fft_cpx) * nfft ,1, fin ) > 0 ) {
+ kiss_fft( st , buf ,bufout);
+ fwrite( bufout , sizeof(kiss_fft_cpx) , nfft , fout );
+ }
+ free(st);
+ free(buf);
+ free(bufout);
+}
+
+static
+void fft_filend(FILE * fin,FILE * fout,int *dims,int ndims,int isinverse)
+{
+ kiss_fftnd_cfg st;
+ kiss_fft_cpx *buf;
+ int dimprod=1,i;
+ for (i=0;i 0) {
+ kiss_fftnd (st, buf, buf);
+ fwrite (buf, sizeof (kiss_fft_cpx), dimprod, fout);
+ }
+ free (st);
+ free (buf);
+}
+
+
+
+static
+void fft_filend_real(FILE * fin,FILE * fout,int *dims,int ndims,int isinverse)
+{
+ int dimprod=1,i;
+ kiss_fftndr_cfg st;
+ void *ibuf;
+ void *obuf;
+ int insize,outsize; // size in bytes
+
+ for (i=0;i 0) {
+ if (isinverse) {
+ kiss_fftndri(st,
+ (kiss_fft_cpx*)ibuf,
+ (kiss_fft_scalar*)obuf);
+ }else{
+ kiss_fftndr(st,
+ (kiss_fft_scalar*)ibuf,
+ (kiss_fft_cpx*)obuf);
+ }
+ fwrite (obuf, sizeof(kiss_fft_scalar), outsize,fout);
+ }
+ free(st);
+ free(ibuf);
+ free(obuf);
+}
+
+static
+void fft_file_real(FILE * fin,FILE * fout,int nfft,int isinverse)
+{
+ kiss_fftr_cfg st;
+ kiss_fft_scalar * rbuf;
+ kiss_fft_cpx * cbuf;
+
+ rbuf = (kiss_fft_scalar*)malloc(sizeof(kiss_fft_scalar) * nfft );
+ cbuf = (kiss_fft_cpx*)malloc(sizeof(kiss_fft_cpx) * (nfft/2+1) );
+ st = kiss_fftr_alloc( nfft ,isinverse ,0,0);
+
+ if (isinverse==0) {
+ while ( fread( rbuf , sizeof(kiss_fft_scalar) * nfft ,1, fin ) > 0 ) {
+ kiss_fftr( st , rbuf ,cbuf);
+ fwrite( cbuf , sizeof(kiss_fft_cpx) , (nfft/2 + 1) , fout );
+ }
+ }else{
+ while ( fread( cbuf , sizeof(kiss_fft_cpx) * (nfft/2+1) ,1, fin ) > 0 ) {
+ kiss_fftri( st , cbuf ,rbuf);
+ fwrite( rbuf , sizeof(kiss_fft_scalar) , nfft , fout );
+ }
+ }
+ free(st);
+ free(rbuf);
+ free(cbuf);
+}
+
+static
+int get_dims(char * arg,int * dims)
+{
+ char *p0;
+ int ndims=0;
+
+ do{
+ p0 = strchr(arg,',');
+ if (p0)
+ *p0++ = '\0';
+ dims[ndims++] = atoi(arg);
+// fprintf(stderr,"dims[%d] = %d\n",ndims-1,dims[ndims-1]);
+ arg = p0;
+ }while (p0);
+ return ndims;
+}
+
+int main(int argc,char ** argv)
+{
+ int isinverse=0;
+ int isreal=0;
+ FILE *fin=stdin;
+ FILE *fout=stdout;
+ int ndims=1;
+ int dims[32];
+ dims[0] = 1024; /*default fft size*/
+
+ while (1) {
+ int c=getopt(argc,argv,"n:iR");
+ if (c==-1) break;
+ switch (c) {
+ case 'n':
+ ndims = get_dims(optarg,dims);
+ break;
+ case 'i':isinverse=1;break;
+ case 'R':isreal=1;break;
+ case '?':
+ fprintf(stderr,"usage options:\n"
+ "\t-n d1[,d2,d3...]: fft dimension(s)\n"
+ "\t-i : inverse\n"
+ "\t-R : real input samples, not complex\n");
+ exit (1);
+ default:fprintf(stderr,"bad %c\n",c);break;
+ }
+ }
+
+ if ( optind < argc ) {
+ if (strcmp("-",argv[optind]) !=0)
+ fin = fopen(argv[optind],"rb");
+ ++optind;
+ }
+
+ if ( optind < argc ) {
+ if ( strcmp("-",argv[optind]) !=0 )
+ fout = fopen(argv[optind],"wb");
+ ++optind;
+ }
+
+ if (ndims==1) {
+ if (isreal)
+ fft_file_real(fin,fout,dims[0],isinverse);
+ else
+ fft_file(fin,fout,dims[0],isinverse);
+ }else{
+ if (isreal)
+ fft_filend_real(fin,fout,dims,ndims,isinverse);
+ else
+ fft_filend(fin,fout,dims,ndims,isinverse);
+ }
+
+ if (fout!=stdout) fclose(fout);
+ if (fin!=stdin) fclose(fin);
+
+ return 0;
+}
diff --git a/thirdparty/kiss_fft130/tools/kfc.c b/thirdparty/kiss_fft130/tools/kfc.c
new file mode 100644
index 00000000..d94d1240
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/kfc.c
@@ -0,0 +1,116 @@
+#include "kfc.h"
+
+/*
+Copyright (c) 2003-2004, Mark Borgerding
+
+All rights reserved.
+
+Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:
+
+ * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
+ * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution.
+ * Neither the author nor the names of any contributors may be used to endorse or promote products derived from this software without specific prior written permission.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+
+typedef struct cached_fft *kfc_cfg;
+
+struct cached_fft
+{
+ int nfft;
+ int inverse;
+ kiss_fft_cfg cfg;
+ kfc_cfg next;
+};
+
+static kfc_cfg cache_root=NULL;
+static int ncached=0;
+
+static kiss_fft_cfg find_cached_fft(int nfft,int inverse)
+{
+ size_t len;
+ kfc_cfg cur=cache_root;
+ kfc_cfg prev=NULL;
+ while ( cur ) {
+ if ( cur->nfft == nfft && inverse == cur->inverse )
+ break;/*found the right node*/
+ prev = cur;
+ cur = prev->next;
+ }
+ if (cur== NULL) {
+ /* no cached node found, need to create a new one*/
+ kiss_fft_alloc(nfft,inverse,0,&len);
+#ifdef USE_SIMD
+ int padding = (16-sizeof(struct cached_fft)) & 15;
+ // make sure the cfg aligns on a 16 byte boundary
+ len += padding;
+#endif
+ cur = (kfc_cfg)KISS_FFT_MALLOC((sizeof(struct cached_fft) + len ));
+ if (cur == NULL)
+ return NULL;
+ cur->cfg = (kiss_fft_cfg)(cur+1);
+#ifdef USE_SIMD
+ cur->cfg = (kiss_fft_cfg) ((char*)(cur+1)+padding);
+#endif
+ kiss_fft_alloc(nfft,inverse,cur->cfg,&len);
+ cur->nfft=nfft;
+ cur->inverse=inverse;
+ cur->next = NULL;
+ if ( prev )
+ prev->next = cur;
+ else
+ cache_root = cur;
+ ++ncached;
+ }
+ return cur->cfg;
+}
+
+void kfc_cleanup(void)
+{
+ kfc_cfg cur=cache_root;
+ kfc_cfg next=NULL;
+ while (cur){
+ next = cur->next;
+ free(cur);
+ cur=next;
+ }
+ ncached=0;
+ cache_root = NULL;
+}
+void kfc_fft(int nfft, const kiss_fft_cpx * fin,kiss_fft_cpx * fout)
+{
+ kiss_fft( find_cached_fft(nfft,0),fin,fout );
+}
+
+void kfc_ifft(int nfft, const kiss_fft_cpx * fin,kiss_fft_cpx * fout)
+{
+ kiss_fft( find_cached_fft(nfft,1),fin,fout );
+}
+
+#ifdef KFC_TEST
+static void check(int nc)
+{
+ if (ncached != nc) {
+ fprintf(stderr,"ncached should be %d,but it is %d\n",nc,ncached);
+ exit(1);
+ }
+}
+
+int main(void)
+{
+ kiss_fft_cpx buf1[1024],buf2[1024];
+ memset(buf1,0,sizeof(buf1));
+ check(0);
+ kfc_fft(512,buf1,buf2);
+ check(1);
+ kfc_fft(512,buf1,buf2);
+ check(1);
+ kfc_ifft(512,buf1,buf2);
+ check(2);
+ kfc_cleanup();
+ check(0);
+ return 0;
+}
+#endif
diff --git a/thirdparty/kiss_fft130/tools/kfc.h b/thirdparty/kiss_fft130/tools/kfc.h
new file mode 100644
index 00000000..9b5fd677
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/kfc.h
@@ -0,0 +1,46 @@
+#ifndef KFC_H
+#define KFC_H
+#include "kiss_fft.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/*
+KFC -- Kiss FFT Cache
+
+Not needing to deal with kiss_fft_alloc and a config
+object may be handy for a lot of programs.
+
+KFC uses the underlying KISS FFT functions, but caches the config object.
+The first time kfc_fft or kfc_ifft for a given FFT size, the cfg
+object is created for it. All subsequent calls use the cached
+configuration object.
+
+NOTE:
+You should probably not use this if your program will be using a lot
+of various sizes of FFTs. There is a linear search through the
+cached objects. If you are only using one or two FFT sizes, this
+will be negligible. Otherwise, you may want to use another method
+of managing the cfg objects.
+
+ There is no automated cleanup of the cached objects. This could lead
+to large memory usage in a program that uses a lot of *DIFFERENT*
+sized FFTs. If you want to force all cached cfg objects to be freed,
+call kfc_cleanup.
+
+ */
+
+/*forward complex FFT */
+void kfc_fft(int nfft, const kiss_fft_cpx * fin,kiss_fft_cpx * fout);
+/*reverse complex FFT */
+void kfc_ifft(int nfft, const kiss_fft_cpx * fin,kiss_fft_cpx * fout);
+
+/*free all cached objects*/
+void kfc_cleanup(void);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
diff --git a/thirdparty/kiss_fft130/tools/kiss_fastfir.c b/thirdparty/kiss_fft130/tools/kiss_fastfir.c
new file mode 100644
index 00000000..4560aa37
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/kiss_fastfir.c
@@ -0,0 +1,470 @@
+/*
+Copyright (c) 2003-2004, Mark Borgerding
+
+All rights reserved.
+
+Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:
+
+ * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
+ * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution.
+ * Neither the author nor the names of any contributors may be used to endorse or promote products derived from this software without specific prior written permission.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#include "_kiss_fft_guts.h"
+
+
+/*
+ Some definitions that allow real or complex filtering
+*/
+#ifdef REAL_FASTFIR
+#define MIN_FFT_LEN 2048
+#include "kiss_fftr.h"
+typedef kiss_fft_scalar kffsamp_t;
+typedef kiss_fftr_cfg kfcfg_t;
+#define FFT_ALLOC kiss_fftr_alloc
+#define FFTFWD kiss_fftr
+#define FFTINV kiss_fftri
+#else
+#define MIN_FFT_LEN 1024
+typedef kiss_fft_cpx kffsamp_t;
+typedef kiss_fft_cfg kfcfg_t;
+#define FFT_ALLOC kiss_fft_alloc
+#define FFTFWD kiss_fft
+#define FFTINV kiss_fft
+#endif
+
+typedef struct kiss_fastfir_state *kiss_fastfir_cfg;
+
+
+
+kiss_fastfir_cfg kiss_fastfir_alloc(const kffsamp_t * imp_resp,size_t n_imp_resp,
+ size_t * nfft,void * mem,size_t*lenmem);
+
+/* see do_file_filter for usage */
+size_t kiss_fastfir( kiss_fastfir_cfg cfg, kffsamp_t * inbuf, kffsamp_t * outbuf, size_t n, size_t *offset);
+
+
+
+static int verbose=0;
+
+
+struct kiss_fastfir_state{
+ size_t nfft;
+ size_t ngood;
+ kfcfg_t fftcfg;
+ kfcfg_t ifftcfg;
+ kiss_fft_cpx * fir_freq_resp;
+ kiss_fft_cpx * freqbuf;
+ size_t n_freq_bins;
+ kffsamp_t * tmpbuf;
+};
+
+
+kiss_fastfir_cfg kiss_fastfir_alloc(
+ const kffsamp_t * imp_resp,size_t n_imp_resp,
+ size_t *pnfft, /* if <= 0, an appropriate size will be chosen */
+ void * mem,size_t*lenmem)
+{
+ kiss_fastfir_cfg st = NULL;
+ size_t len_fftcfg,len_ifftcfg;
+ size_t memneeded = sizeof(struct kiss_fastfir_state);
+ char * ptr;
+ size_t i;
+ size_t nfft=0;
+ float scale;
+ int n_freq_bins;
+ if (pnfft)
+ nfft=*pnfft;
+
+ if (nfft<=0) {
+ /* determine fft size as next power of two at least 2x
+ the impulse response length*/
+ i=n_imp_resp-1;
+ nfft=2;
+ do{
+ nfft<<=1;
+ }while (i>>=1);
+#ifdef MIN_FFT_LEN
+ if ( nfft < MIN_FFT_LEN )
+ nfft=MIN_FFT_LEN;
+#endif
+ }
+ if (pnfft)
+ *pnfft = nfft;
+
+#ifdef REAL_FASTFIR
+ n_freq_bins = nfft/2 + 1;
+#else
+ n_freq_bins = nfft;
+#endif
+ /*fftcfg*/
+ FFT_ALLOC (nfft, 0, NULL, &len_fftcfg);
+ memneeded += len_fftcfg;
+ /*ifftcfg*/
+ FFT_ALLOC (nfft, 1, NULL, &len_ifftcfg);
+ memneeded += len_ifftcfg;
+ /* tmpbuf */
+ memneeded += sizeof(kffsamp_t) * nfft;
+ /* fir_freq_resp */
+ memneeded += sizeof(kiss_fft_cpx) * n_freq_bins;
+ /* freqbuf */
+ memneeded += sizeof(kiss_fft_cpx) * n_freq_bins;
+
+ if (lenmem == NULL) {
+ st = (kiss_fastfir_cfg) malloc (memneeded);
+ } else {
+ if (*lenmem >= memneeded)
+ st = (kiss_fastfir_cfg) mem;
+ *lenmem = memneeded;
+ }
+ if (!st)
+ return NULL;
+
+ st->nfft = nfft;
+ st->ngood = nfft - n_imp_resp + 1;
+ st->n_freq_bins = n_freq_bins;
+ ptr=(char*)(st+1);
+
+ st->fftcfg = (kfcfg_t)ptr;
+ ptr += len_fftcfg;
+
+ st->ifftcfg = (kfcfg_t)ptr;
+ ptr += len_ifftcfg;
+
+ st->tmpbuf = (kffsamp_t*)ptr;
+ ptr += sizeof(kffsamp_t) * nfft;
+
+ st->freqbuf = (kiss_fft_cpx*)ptr;
+ ptr += sizeof(kiss_fft_cpx) * n_freq_bins;
+
+ st->fir_freq_resp = (kiss_fft_cpx*)ptr;
+ ptr += sizeof(kiss_fft_cpx) * n_freq_bins;
+
+ FFT_ALLOC (nfft,0,st->fftcfg , &len_fftcfg);
+ FFT_ALLOC (nfft,1,st->ifftcfg , &len_ifftcfg);
+
+ memset(st->tmpbuf,0,sizeof(kffsamp_t)*nfft);
+ /*zero pad in the middle to left-rotate the impulse response
+ This puts the scrap samples at the end of the inverse fft'd buffer */
+ st->tmpbuf[0] = imp_resp[ n_imp_resp - 1 ];
+ for (i=0;itmpbuf[ nfft - n_imp_resp + 1 + i ] = imp_resp[ i ];
+ }
+
+ FFTFWD(st->fftcfg,st->tmpbuf,st->fir_freq_resp);
+
+ /* TODO: this won't work for fixed point */
+ scale = 1.0 / st->nfft;
+
+ for ( i=0; i < st->n_freq_bins; ++i ) {
+#ifdef USE_SIMD
+ st->fir_freq_resp[i].r *= _mm_set1_ps(scale);
+ st->fir_freq_resp[i].i *= _mm_set1_ps(scale);
+#else
+ st->fir_freq_resp[i].r *= scale;
+ st->fir_freq_resp[i].i *= scale;
+#endif
+ }
+ return st;
+}
+
+static void fastconv1buf(const kiss_fastfir_cfg st,const kffsamp_t * in,kffsamp_t * out)
+{
+ size_t i;
+ /* multiply the frequency response of the input signal by
+ that of the fir filter*/
+ FFTFWD( st->fftcfg, in , st->freqbuf );
+ for ( i=0; in_freq_bins; ++i ) {
+ kiss_fft_cpx tmpsamp;
+ C_MUL(tmpsamp,st->freqbuf[i],st->fir_freq_resp[i]);
+ st->freqbuf[i] = tmpsamp;
+ }
+
+ /* perform the inverse fft*/
+ FFTINV(st->ifftcfg,st->freqbuf,out);
+}
+
+/* n : the size of inbuf and outbuf in samples
+ return value: the number of samples completely processed
+ n-retval samples should be copied to the front of the next input buffer */
+static size_t kff_nocopy(
+ kiss_fastfir_cfg st,
+ const kffsamp_t * inbuf,
+ kffsamp_t * outbuf,
+ size_t n)
+{
+ size_t norig=n;
+ while (n >= st->nfft ) {
+ fastconv1buf(st,inbuf,outbuf);
+ inbuf += st->ngood;
+ outbuf += st->ngood;
+ n -= st->ngood;
+ }
+ return norig - n;
+}
+
+static
+size_t kff_flush(kiss_fastfir_cfg st,const kffsamp_t * inbuf,kffsamp_t * outbuf,size_t n)
+{
+ size_t zpad=0,ntmp;
+
+ ntmp = kff_nocopy(st,inbuf,outbuf,n);
+ n -= ntmp;
+ inbuf += ntmp;
+ outbuf += ntmp;
+
+ zpad = st->nfft - n;
+ memset(st->tmpbuf,0,sizeof(kffsamp_t)*st->nfft );
+ memcpy(st->tmpbuf,inbuf,sizeof(kffsamp_t)*n );
+
+ fastconv1buf(st,st->tmpbuf,st->tmpbuf);
+
+ memcpy(outbuf,st->tmpbuf,sizeof(kffsamp_t)*( st->ngood - zpad ));
+ return ntmp + st->ngood - zpad;
+}
+
+size_t kiss_fastfir(
+ kiss_fastfir_cfg vst,
+ kffsamp_t * inbuf,
+ kffsamp_t * outbuf,
+ size_t n_new,
+ size_t *offset)
+{
+ size_t ntot = n_new + *offset;
+ if (n_new==0) {
+ return kff_flush(vst,inbuf,outbuf,ntot);
+ }else{
+ size_t nwritten = kff_nocopy(vst,inbuf,outbuf,ntot);
+ *offset = ntot - nwritten;
+ /*save the unused or underused samples at the front of the input buffer */
+ memcpy( inbuf , inbuf+nwritten , *offset * sizeof(kffsamp_t) );
+ return nwritten;
+ }
+}
+
+#ifdef FAST_FILT_UTIL
+#include
+#include
+#include
+#include
+
+static
+void direct_file_filter(
+ FILE * fin,
+ FILE * fout,
+ const kffsamp_t * imp_resp,
+ size_t n_imp_resp)
+{
+ size_t nlag = n_imp_resp - 1;
+
+ const kffsamp_t *tmph;
+ kffsamp_t *buf, *circbuf;
+ kffsamp_t outval;
+ size_t nread;
+ size_t nbuf;
+ size_t oldestlag = 0;
+ size_t k, tap;
+#ifndef REAL_FASTFIR
+ kffsamp_t tmp;
+#endif
+
+ nbuf = 4096;
+ buf = (kffsamp_t *) malloc ( sizeof (kffsamp_t) * nbuf);
+ circbuf = (kffsamp_t *) malloc (sizeof (kffsamp_t) * nlag);
+ if (!circbuf || !buf) {
+ perror("circbuf allocation");
+ exit(1);
+ }
+
+ if ( fread (circbuf, sizeof (kffsamp_t), nlag, fin) != nlag ) {
+ perror ("insufficient data to overcome transient");
+ exit (1);
+ }
+
+ do {
+ nread = fread (buf, sizeof (kffsamp_t), nbuf, fin);
+ if (nread <= 0)
+ break;
+
+ for (k = 0; k < nread; ++k) {
+ tmph = imp_resp+nlag;
+#ifdef REAL_FASTFIR
+# ifdef USE_SIMD
+ outval = _mm_set1_ps(0);
+#else
+ outval = 0;
+#endif
+ for (tap = oldestlag; tap < nlag; ++tap)
+ outval += circbuf[tap] * *tmph--;
+ for (tap = 0; tap < oldestlag; ++tap)
+ outval += circbuf[tap] * *tmph--;
+ outval += buf[k] * *tmph;
+#else
+# ifdef USE_SIMD
+ outval.r = outval.i = _mm_set1_ps(0);
+#else
+ outval.r = outval.i = 0;
+#endif
+ for (tap = oldestlag; tap < nlag; ++tap){
+ C_MUL(tmp,circbuf[tap],*tmph);
+ --tmph;
+ C_ADDTO(outval,tmp);
+ }
+
+ for (tap = 0; tap < oldestlag; ++tap) {
+ C_MUL(tmp,circbuf[tap],*tmph);
+ --tmph;
+ C_ADDTO(outval,tmp);
+ }
+ C_MUL(tmp,buf[k],*tmph);
+ C_ADDTO(outval,tmp);
+#endif
+
+ circbuf[oldestlag++] = buf[k];
+ buf[k] = outval;
+
+ if (oldestlag == nlag)
+ oldestlag = 0;
+ }
+
+ if (fwrite (buf, sizeof (buf[0]), nread, fout) != nread) {
+ perror ("short write");
+ exit (1);
+ }
+ } while (nread);
+ free (buf);
+ free (circbuf);
+}
+
+static
+void do_file_filter(
+ FILE * fin,
+ FILE * fout,
+ const kffsamp_t * imp_resp,
+ size_t n_imp_resp,
+ size_t nfft )
+{
+ int fdout;
+ size_t n_samps_buf;
+
+ kiss_fastfir_cfg cfg;
+ kffsamp_t *inbuf,*outbuf;
+ int nread,nwrite;
+ size_t idx_inbuf;
+
+ fdout = fileno(fout);
+
+ cfg=kiss_fastfir_alloc(imp_resp,n_imp_resp,&nfft,0,0);
+
+ /* use length to minimize buffer shift*/
+ n_samps_buf = 8*4096/sizeof(kffsamp_t);
+ n_samps_buf = nfft + 4*(nfft-n_imp_resp+1);
+
+ if (verbose) fprintf(stderr,"bufsize=%d\n",(int)(sizeof(kffsamp_t)*n_samps_buf) );
+
+
+ /*allocate space and initialize pointers */
+ inbuf = (kffsamp_t*)malloc(sizeof(kffsamp_t)*n_samps_buf);
+ outbuf = (kffsamp_t*)malloc(sizeof(kffsamp_t)*n_samps_buf);
+
+ idx_inbuf=0;
+ do{
+ /* start reading at inbuf[idx_inbuf] */
+ nread = fread( inbuf + idx_inbuf, sizeof(kffsamp_t), n_samps_buf - idx_inbuf,fin );
+
+ /* If nread==0, then this is a flush.
+ The total number of samples in input is idx_inbuf + nread . */
+ nwrite = kiss_fastfir(cfg, inbuf, outbuf,nread,&idx_inbuf) * sizeof(kffsamp_t);
+ /* kiss_fastfir moved any unused samples to the front of inbuf and updated idx_inbuf */
+
+ if ( write(fdout, outbuf, nwrite) != nwrite ) {
+ perror("short write");
+ exit(1);
+ }
+ }while ( nread );
+ free(cfg);
+ free(inbuf);
+ free(outbuf);
+}
+
+int main(int argc,char**argv)
+{
+ kffsamp_t * h;
+ int use_direct=0;
+ size_t nh,nfft=0;
+ FILE *fin=stdin;
+ FILE *fout=stdout;
+ FILE *filtfile=NULL;
+ while (1) {
+ int c=getopt(argc,argv,"n:h:i:o:vd");
+ if (c==-1) break;
+ switch (c) {
+ case 'v':
+ verbose=1;
+ break;
+ case 'n':
+ nfft=atoi(optarg);
+ break;
+ case 'i':
+ fin = fopen(optarg,"rb");
+ if (fin==NULL) {
+ perror(optarg);
+ exit(1);
+ }
+ break;
+ case 'o':
+ fout = fopen(optarg,"w+b");
+ if (fout==NULL) {
+ perror(optarg);
+ exit(1);
+ }
+ break;
+ case 'h':
+ filtfile = fopen(optarg,"rb");
+ if (filtfile==NULL) {
+ perror(optarg);
+ exit(1);
+ }
+ break;
+ case 'd':
+ use_direct=1;
+ break;
+ case '?':
+ fprintf(stderr,"usage options:\n"
+ "\t-n nfft: fft size to use\n"
+ "\t-d : use direct FIR filtering, not fast convolution\n"
+ "\t-i filename: input file\n"
+ "\t-o filename: output(filtered) file\n"
+ "\t-n nfft: fft size to use\n"
+ "\t-h filename: impulse response\n");
+ exit (1);
+ default:fprintf(stderr,"bad %c\n",c);break;
+ }
+ }
+ if (filtfile==NULL) {
+ fprintf(stderr,"You must supply the FIR coeffs via -h\n");
+ exit(1);
+ }
+ fseek(filtfile,0,SEEK_END);
+ nh = ftell(filtfile) / sizeof(kffsamp_t);
+ if (verbose) fprintf(stderr,"%d samples in FIR filter\n",(int)nh);
+ h = (kffsamp_t*)malloc(sizeof(kffsamp_t)*nh);
+ fseek(filtfile,0,SEEK_SET);
+ if (fread(h,sizeof(kffsamp_t),nh,filtfile) != nh)
+ fprintf(stderr,"short read on filter file\n");
+
+ fclose(filtfile);
+
+ if (use_direct)
+ direct_file_filter( fin, fout, h,nh);
+ else
+ do_file_filter( fin, fout, h,nh,nfft);
+
+ if (fout!=stdout) fclose(fout);
+ if (fin!=stdin) fclose(fin);
+
+ return 0;
+}
+#endif
diff --git a/thirdparty/kiss_fft130/tools/kiss_fftnd.c b/thirdparty/kiss_fft130/tools/kiss_fftnd.c
new file mode 100644
index 00000000..d6c91243
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/kiss_fftnd.c
@@ -0,0 +1,193 @@
+
+
+/*
+Copyright (c) 2003-2004, Mark Borgerding
+
+All rights reserved.
+
+Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:
+
+ * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
+ * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution.
+ * Neither the author nor the names of any contributors may be used to endorse or promote products derived from this software without specific prior written permission.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#include "kiss_fftnd.h"
+#include "_kiss_fft_guts.h"
+
+struct kiss_fftnd_state{
+ int dimprod; /* dimsum would be mighty tasty right now */
+ int ndims;
+ int *dims;
+ kiss_fft_cfg *states; /* cfg states for each dimension */
+ kiss_fft_cpx * tmpbuf; /*buffer capable of hold the entire input */
+};
+
+kiss_fftnd_cfg kiss_fftnd_alloc(const int *dims,int ndims,int inverse_fft,void*mem,size_t*lenmem)
+{
+ kiss_fftnd_cfg st = NULL;
+ int i;
+ int dimprod=1;
+ size_t memneeded = sizeof(struct kiss_fftnd_state);
+ char * ptr;
+
+ for (i=0;istates[i] */
+ dimprod *= dims[i];
+ }
+ memneeded += sizeof(int) * ndims;/* st->dims */
+ memneeded += sizeof(void*) * ndims;/* st->states */
+ memneeded += sizeof(kiss_fft_cpx) * dimprod; /* st->tmpbuf */
+
+ if (lenmem == NULL) {/* allocate for the caller*/
+ st = (kiss_fftnd_cfg) malloc (memneeded);
+ } else { /* initialize supplied buffer if big enough */
+ if (*lenmem >= memneeded)
+ st = (kiss_fftnd_cfg) mem;
+ *lenmem = memneeded; /*tell caller how big struct is (or would be) */
+ }
+ if (!st)
+ return NULL; /*malloc failed or buffer too small */
+
+ st->dimprod = dimprod;
+ st->ndims = ndims;
+ ptr=(char*)(st+1);
+
+ st->states = (kiss_fft_cfg *)ptr;
+ ptr += sizeof(void*) * ndims;
+
+ st->dims = (int*)ptr;
+ ptr += sizeof(int) * ndims;
+
+ st->tmpbuf = (kiss_fft_cpx*)ptr;
+ ptr += sizeof(kiss_fft_cpx) * dimprod;
+
+ for (i=0;idims[i] = dims[i];
+ kiss_fft_alloc (st->dims[i], inverse_fft, NULL, &len);
+ st->states[i] = kiss_fft_alloc (st->dims[i], inverse_fft, ptr,&len);
+ ptr += len;
+ }
+ /*
+Hi there!
+
+If you're looking at this particular code, it probably means you've got a brain-dead bounds checker
+that thinks the above code overwrites the end of the array.
+
+It doesn't.
+
+-- Mark
+
+P.S.
+The below code might give you some warm fuzzies and help convince you.
+ */
+ if ( ptr - (char*)st != (int)memneeded ) {
+ fprintf(stderr,
+ "################################################################################\n"
+ "Internal error! Memory allocation miscalculation\n"
+ "################################################################################\n"
+ );
+ }
+ return st;
+}
+
+/*
+ This works by tackling one dimension at a time.
+
+ In effect,
+ Each stage starts out by reshaping the matrix into a DixSi 2d matrix.
+ A Di-sized fft is taken of each column, transposing the matrix as it goes.
+
+Here's a 3-d example:
+Take a 2x3x4 matrix, laid out in memory as a contiguous buffer
+ [ [ [ a b c d ] [ e f g h ] [ i j k l ] ]
+ [ [ m n o p ] [ q r s t ] [ u v w x ] ] ]
+
+Stage 0 ( D=2): treat the buffer as a 2x12 matrix
+ [ [a b ... k l]
+ [m n ... w x] ]
+
+ FFT each column with size 2.
+ Transpose the matrix at the same time using kiss_fft_stride.
+
+ [ [ a+m a-m ]
+ [ b+n b-n]
+ ...
+ [ k+w k-w ]
+ [ l+x l-x ] ]
+
+ Note fft([x y]) == [x+y x-y]
+
+Stage 1 ( D=3) treats the buffer (the output of stage D=2) as an 3x8 matrix,
+ [ [ a+m a-m b+n b-n c+o c-o d+p d-p ]
+ [ e+q e-q f+r f-r g+s g-s h+t h-t ]
+ [ i+u i-u j+v j-v k+w k-w l+x l-x ] ]
+
+ And perform FFTs (size=3) on each of the columns as above, transposing
+ the matrix as it goes. The output of stage 1 is
+ (Legend: ap = [ a+m e+q i+u ]
+ am = [ a-m e-q i-u ] )
+
+ [ [ sum(ap) fft(ap)[0] fft(ap)[1] ]
+ [ sum(am) fft(am)[0] fft(am)[1] ]
+ [ sum(bp) fft(bp)[0] fft(bp)[1] ]
+ [ sum(bm) fft(bm)[0] fft(bm)[1] ]
+ [ sum(cp) fft(cp)[0] fft(cp)[1] ]
+ [ sum(cm) fft(cm)[0] fft(cm)[1] ]
+ [ sum(dp) fft(dp)[0] fft(dp)[1] ]
+ [ sum(dm) fft(dm)[0] fft(dm)[1] ] ]
+
+Stage 2 ( D=4) treats this buffer as a 4*6 matrix,
+ [ [ sum(ap) fft(ap)[0] fft(ap)[1] sum(am) fft(am)[0] fft(am)[1] ]
+ [ sum(bp) fft(bp)[0] fft(bp)[1] sum(bm) fft(bm)[0] fft(bm)[1] ]
+ [ sum(cp) fft(cp)[0] fft(cp)[1] sum(cm) fft(cm)[0] fft(cm)[1] ]
+ [ sum(dp) fft(dp)[0] fft(dp)[1] sum(dm) fft(dm)[0] fft(dm)[1] ] ]
+
+ Then FFTs each column, transposing as it goes.
+
+ The resulting matrix is the 3d FFT of the 2x3x4 input matrix.
+
+ Note as a sanity check that the first element of the final
+ stage's output (DC term) is
+ sum( [ sum(ap) sum(bp) sum(cp) sum(dp) ] )
+ , i.e. the summation of all 24 input elements.
+
+*/
+void kiss_fftnd(kiss_fftnd_cfg st,const kiss_fft_cpx *fin,kiss_fft_cpx *fout)
+{
+ int i,k;
+ const kiss_fft_cpx * bufin=fin;
+ kiss_fft_cpx * bufout;
+
+ /*arrange it so the last bufout == fout*/
+ if ( st->ndims & 1 ) {
+ bufout = fout;
+ if (fin==fout) {
+ memcpy( st->tmpbuf, fin, sizeof(kiss_fft_cpx) * st->dimprod );
+ bufin = st->tmpbuf;
+ }
+ }else
+ bufout = st->tmpbuf;
+
+ for ( k=0; k < st->ndims; ++k) {
+ int curdim = st->dims[k];
+ int stride = st->dimprod / curdim;
+
+ for ( i=0 ; istates[k], bufin+i , bufout+i*curdim, stride );
+
+ /*toggle back and forth between the two buffers*/
+ if (bufout == st->tmpbuf){
+ bufout = fout;
+ bufin = st->tmpbuf;
+ }else{
+ bufout = st->tmpbuf;
+ bufin = fout;
+ }
+ }
+}
diff --git a/thirdparty/kiss_fft130/tools/kiss_fftnd.h b/thirdparty/kiss_fft130/tools/kiss_fftnd.h
new file mode 100644
index 00000000..42e7df5b
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/kiss_fftnd.h
@@ -0,0 +1,18 @@
+#ifndef KISS_FFTND_H
+#define KISS_FFTND_H
+
+#include "kiss_fft.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+typedef struct kiss_fftnd_state * kiss_fftnd_cfg;
+
+kiss_fftnd_cfg kiss_fftnd_alloc(const int *dims,int ndims,int inverse_fft,void*mem,size_t*lenmem);
+void kiss_fftnd(kiss_fftnd_cfg cfg,const kiss_fft_cpx *fin,kiss_fft_cpx *fout);
+
+#ifdef __cplusplus
+}
+#endif
+#endif
diff --git a/thirdparty/kiss_fft130/tools/kiss_fftndr.c b/thirdparty/kiss_fft130/tools/kiss_fftndr.c
new file mode 100644
index 00000000..ba550dd1
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/kiss_fftndr.c
@@ -0,0 +1,118 @@
+/*
+Copyright (c) 2003-2004, Mark Borgerding
+
+All rights reserved.
+
+Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:
+
+ * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
+ * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution.
+ * Neither the author nor the names of any contributors may be used to endorse or promote products derived from this software without specific prior written permission.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#include "kiss_fftndr.h"
+#include "_kiss_fft_guts.h"
+#define MAX(x,y) ( ( (x)<(y) )?(y):(x) )
+
+struct kiss_fftndr_state
+{
+ int dimReal;
+ int dimOther;
+ kiss_fftr_cfg cfg_r;
+ kiss_fftnd_cfg cfg_nd;
+ void * tmpbuf;
+};
+
+static int prod(const int *dims, int ndims)
+{
+ int x=1;
+ while (ndims--)
+ x *= *dims++;
+ return x;
+}
+
+kiss_fftndr_cfg kiss_fftndr_alloc(const int *dims,int ndims,int inverse_fft,void*mem,size_t*lenmem)
+{
+ kiss_fftndr_cfg st = NULL;
+ size_t nr=0 , nd=0,ntmp=0;
+ int dimReal = dims[ndims-1];
+ int dimOther = prod(dims,ndims-1);
+ size_t memneeded;
+
+ (void)kiss_fftr_alloc(dimReal,inverse_fft,NULL,&nr);
+ (void)kiss_fftnd_alloc(dims,ndims-1,inverse_fft,NULL,&nd);
+ ntmp =
+ MAX( 2*dimOther , dimReal+2) * sizeof(kiss_fft_scalar) // freq buffer for one pass
+ + dimOther*(dimReal+2) * sizeof(kiss_fft_scalar); // large enough to hold entire input in case of in-place
+
+ memneeded = sizeof( struct kiss_fftndr_state ) + nr + nd + ntmp;
+
+ if (lenmem==NULL) {
+ st = (kiss_fftndr_cfg) malloc(memneeded);
+ }else{
+ if (*lenmem >= memneeded)
+ st = (kiss_fftndr_cfg)mem;
+ *lenmem = memneeded;
+ }
+ if (st==NULL)
+ return NULL;
+ memset( st , 0 , memneeded);
+
+ st->dimReal = dimReal;
+ st->dimOther = dimOther;
+ st->cfg_r = kiss_fftr_alloc( dimReal,inverse_fft,st+1,&nr);
+ st->cfg_nd = kiss_fftnd_alloc(dims,ndims-1,inverse_fft, ((char*) st->cfg_r)+nr,&nd);
+ st->tmpbuf = (char*)st->cfg_nd + nd;
+
+ return st;
+}
+
+void kiss_fftndr(kiss_fftndr_cfg st,const kiss_fft_scalar *timedata,kiss_fft_cpx *freqdata)
+{
+ int k1,k2;
+ int dimReal = st->dimReal;
+ int dimOther = st->dimOther;
+ int nrbins = dimReal/2+1;
+
+ kiss_fft_cpx * tmp1 = (kiss_fft_cpx*)st->tmpbuf;
+ kiss_fft_cpx * tmp2 = tmp1 + MAX(nrbins,dimOther);
+
+ // timedata is N0 x N1 x ... x Nk real
+
+ // take a real chunk of data, fft it and place the output at correct intervals
+ for (k1=0;k1cfg_r, timedata + k1*dimReal , tmp1 ); // tmp1 now holds nrbins complex points
+ for (k2=0;k2cfg_nd, tmp2+k2*dimOther, tmp1); // tmp1 now holds dimOther complex points
+ for (k1=0;k1dimReal;
+ int dimOther = st->dimOther;
+ int nrbins = dimReal/2+1;
+ kiss_fft_cpx * tmp1 = (kiss_fft_cpx*)st->tmpbuf;
+ kiss_fft_cpx * tmp2 = tmp1 + MAX(nrbins,dimOther);
+
+ for (k2=0;k2cfg_nd, tmp1, tmp2+k2*dimOther);
+ }
+
+ for (k1=0;k1cfg_r,tmp1,timedata + k1*dimReal);
+ }
+}
diff --git a/thirdparty/kiss_fft130/tools/kiss_fftndr.h b/thirdparty/kiss_fft130/tools/kiss_fftndr.h
new file mode 100644
index 00000000..38ec3ab0
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/kiss_fftndr.h
@@ -0,0 +1,47 @@
+#ifndef KISS_NDR_H
+#define KISS_NDR_H
+
+#include "kiss_fft.h"
+#include "kiss_fftr.h"
+#include "kiss_fftnd.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+typedef struct kiss_fftndr_state *kiss_fftndr_cfg;
+
+
+kiss_fftndr_cfg kiss_fftndr_alloc(const int *dims,int ndims,int inverse_fft,void*mem,size_t*lenmem);
+/*
+ dims[0] must be even
+
+ If you don't care to allocate space, use mem = lenmem = NULL
+*/
+
+
+void kiss_fftndr(
+ kiss_fftndr_cfg cfg,
+ const kiss_fft_scalar *timedata,
+ kiss_fft_cpx *freqdata);
+/*
+ input timedata has dims[0] X dims[1] X ... X dims[ndims-1] scalar points
+ output freqdata has dims[0] X dims[1] X ... X dims[ndims-1]/2+1 complex points
+*/
+
+void kiss_fftndri(
+ kiss_fftndr_cfg cfg,
+ const kiss_fft_cpx *freqdata,
+ kiss_fft_scalar *timedata);
+/*
+ input and output dimensions are the exact opposite of kiss_fftndr
+*/
+
+
+#define kiss_fftr_free free
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
diff --git a/thirdparty/kiss_fft130/tools/kiss_fftr.c b/thirdparty/kiss_fft130/tools/kiss_fftr.c
new file mode 100644
index 00000000..b8e238b1
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/kiss_fftr.c
@@ -0,0 +1,159 @@
+/*
+Copyright (c) 2003-2004, Mark Borgerding
+
+All rights reserved.
+
+Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:
+
+ * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
+ * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution.
+ * Neither the author nor the names of any contributors may be used to endorse or promote products derived from this software without specific prior written permission.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#include "kiss_fftr.h"
+#include "_kiss_fft_guts.h"
+
+struct kiss_fftr_state{
+ kiss_fft_cfg substate;
+ kiss_fft_cpx * tmpbuf;
+ kiss_fft_cpx * super_twiddles;
+#ifdef USE_SIMD
+ void * pad;
+#endif
+};
+
+kiss_fftr_cfg kiss_fftr_alloc(int nfft,int inverse_fft,void * mem,size_t * lenmem)
+{
+ int i;
+ kiss_fftr_cfg st = NULL;
+ size_t subsize, memneeded;
+
+ if (nfft & 1) {
+ fprintf(stderr,"Real FFT optimization must be even.\n");
+ return NULL;
+ }
+ nfft >>= 1;
+
+ kiss_fft_alloc (nfft, inverse_fft, NULL, &subsize);
+ memneeded = sizeof(struct kiss_fftr_state) + subsize + sizeof(kiss_fft_cpx) * ( nfft * 3 / 2);
+
+ if (lenmem == NULL) {
+ st = (kiss_fftr_cfg) KISS_FFT_MALLOC (memneeded);
+ } else {
+ if (*lenmem >= memneeded)
+ st = (kiss_fftr_cfg) mem;
+ *lenmem = memneeded;
+ }
+ if (!st)
+ return NULL;
+
+ st->substate = (kiss_fft_cfg) (st + 1); /*just beyond kiss_fftr_state struct */
+ st->tmpbuf = (kiss_fft_cpx *) (((char *) st->substate) + subsize);
+ st->super_twiddles = st->tmpbuf + nfft;
+ kiss_fft_alloc(nfft, inverse_fft, st->substate, &subsize);
+
+ for (i = 0; i < nfft/2; ++i) {
+ double phase =
+ -3.14159265358979323846264338327 * ((double) (i+1) / nfft + .5);
+ if (inverse_fft)
+ phase *= -1;
+ kf_cexp (st->super_twiddles+i,phase);
+ }
+ return st;
+}
+
+void kiss_fftr(kiss_fftr_cfg st,const kiss_fft_scalar *timedata,kiss_fft_cpx *freqdata)
+{
+ /* input buffer timedata is stored row-wise */
+ int k,ncfft;
+ kiss_fft_cpx fpnk,fpk,f1k,f2k,tw,tdc;
+
+ if ( st->substate->inverse) {
+ fprintf(stderr,"kiss fft usage error: improper alloc\n");
+ exit(1);
+ }
+
+ ncfft = st->substate->nfft;
+
+ /*perform the parallel fft of two real signals packed in real,imag*/
+ kiss_fft( st->substate , (const kiss_fft_cpx*)timedata, st->tmpbuf );
+ /* The real part of the DC element of the frequency spectrum in st->tmpbuf
+ * contains the sum of the even-numbered elements of the input time sequence
+ * The imag part is the sum of the odd-numbered elements
+ *
+ * The sum of tdc.r and tdc.i is the sum of the input time sequence.
+ * yielding DC of input time sequence
+ * The difference of tdc.r - tdc.i is the sum of the input (dot product) [1,-1,1,-1...
+ * yielding Nyquist bin of input time sequence
+ */
+
+ tdc.r = st->tmpbuf[0].r;
+ tdc.i = st->tmpbuf[0].i;
+ C_FIXDIV(tdc,2);
+ CHECK_OVERFLOW_OP(tdc.r ,+, tdc.i);
+ CHECK_OVERFLOW_OP(tdc.r ,-, tdc.i);
+ freqdata[0].r = tdc.r + tdc.i;
+ freqdata[ncfft].r = tdc.r - tdc.i;
+#ifdef USE_SIMD
+ freqdata[ncfft].i = freqdata[0].i = _mm_set1_ps(0);
+#else
+ freqdata[ncfft].i = freqdata[0].i = 0;
+#endif
+
+ for ( k=1;k <= ncfft/2 ; ++k ) {
+ fpk = st->tmpbuf[k];
+ fpnk.r = st->tmpbuf[ncfft-k].r;
+ fpnk.i = - st->tmpbuf[ncfft-k].i;
+ C_FIXDIV(fpk,2);
+ C_FIXDIV(fpnk,2);
+
+ C_ADD( f1k, fpk , fpnk );
+ C_SUB( f2k, fpk , fpnk );
+ C_MUL( tw , f2k , st->super_twiddles[k-1]);
+
+ freqdata[k].r = HALF_OF(f1k.r + tw.r);
+ freqdata[k].i = HALF_OF(f1k.i + tw.i);
+ freqdata[ncfft-k].r = HALF_OF(f1k.r - tw.r);
+ freqdata[ncfft-k].i = HALF_OF(tw.i - f1k.i);
+ }
+}
+
+void kiss_fftri(kiss_fftr_cfg st,const kiss_fft_cpx *freqdata,kiss_fft_scalar *timedata)
+{
+ /* input buffer timedata is stored row-wise */
+ int k, ncfft;
+
+ if (st->substate->inverse == 0) {
+ fprintf (stderr, "kiss fft usage error: improper alloc\n");
+ exit (1);
+ }
+
+ ncfft = st->substate->nfft;
+
+ st->tmpbuf[0].r = freqdata[0].r + freqdata[ncfft].r;
+ st->tmpbuf[0].i = freqdata[0].r - freqdata[ncfft].r;
+ C_FIXDIV(st->tmpbuf[0],2);
+
+ for (k = 1; k <= ncfft / 2; ++k) {
+ kiss_fft_cpx fk, fnkc, fek, fok, tmp;
+ fk = freqdata[k];
+ fnkc.r = freqdata[ncfft - k].r;
+ fnkc.i = -freqdata[ncfft - k].i;
+ C_FIXDIV( fk , 2 );
+ C_FIXDIV( fnkc , 2 );
+
+ C_ADD (fek, fk, fnkc);
+ C_SUB (tmp, fk, fnkc);
+ C_MUL (fok, tmp, st->super_twiddles[k-1]);
+ C_ADD (st->tmpbuf[k], fek, fok);
+ C_SUB (st->tmpbuf[ncfft - k], fek, fok);
+#ifdef USE_SIMD
+ st->tmpbuf[ncfft - k].i *= _mm_set1_ps(-1.0);
+#else
+ st->tmpbuf[ncfft - k].i *= -1;
+#endif
+ }
+ kiss_fft (st->substate, st->tmpbuf, (kiss_fft_cpx *) timedata);
+}
diff --git a/thirdparty/kiss_fft130/tools/kiss_fftr.h b/thirdparty/kiss_fft130/tools/kiss_fftr.h
new file mode 100644
index 00000000..72e5a577
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/kiss_fftr.h
@@ -0,0 +1,46 @@
+#ifndef KISS_FTR_H
+#define KISS_FTR_H
+
+#include "kiss_fft.h"
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+/*
+
+ Real optimized version can save about 45% cpu time vs. complex fft of a real seq.
+
+
+
+ */
+
+typedef struct kiss_fftr_state *kiss_fftr_cfg;
+
+
+kiss_fftr_cfg kiss_fftr_alloc(int nfft,int inverse_fft,void * mem, size_t * lenmem);
+/*
+ nfft must be even
+
+ If you don't care to allocate space, use mem = lenmem = NULL
+*/
+
+
+void kiss_fftr(kiss_fftr_cfg cfg,const kiss_fft_scalar *timedata,kiss_fft_cpx *freqdata);
+/*
+ input timedata has nfft scalar points
+ output freqdata has nfft/2+1 complex points
+*/
+
+void kiss_fftri(kiss_fftr_cfg cfg,const kiss_fft_cpx *freqdata,kiss_fft_scalar *timedata);
+/*
+ input freqdata has nfft/2+1 complex points
+ output timedata has nfft scalar points
+*/
+
+#define kiss_fftr_free free
+
+#ifdef __cplusplus
+}
+#endif
+#endif
diff --git a/thirdparty/kiss_fft130/tools/psdpng.c b/thirdparty/kiss_fft130/tools/psdpng.c
new file mode 100644
index 00000000..d11a54fd
--- /dev/null
+++ b/thirdparty/kiss_fft130/tools/psdpng.c
@@ -0,0 +1,235 @@
+/*
+Copyright (c) 2003-2004, Mark Borgerding
+
+All rights reserved.
+
+Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:
+
+ * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
+ * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution.
+ * Neither the author nor the names of any contributors may be used to endorse or promote products derived from this software without specific prior written permission.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+#include
+#include
+#include
+#include
+#include
+#include
+
+#include "kiss_fft.h"
+#include "kiss_fftr.h"
+
+int nfft=1024;
+FILE * fin=NULL;
+FILE * fout=NULL;
+
+int navg=20;
+int remove_dc=0;
+int nrows=0;
+float * vals=NULL;
+int stereo=0;
+
+static
+void config(int argc,char** argv)
+{
+ while (1) {
+ int c = getopt (argc, argv, "n:r:as");
+ if (c == -1)
+ break;
+ switch (c) {
+ case 'n': nfft=(int)atoi(optarg);break;
+ case 'r': navg=(int)atoi(optarg);break;
+ case 'a': remove_dc=1;break;
+ case 's': stereo=1;break;
+ case '?':
+ fprintf (stderr, "usage options:\n"
+ "\t-n d: fft dimension(s) [1024]\n"
+ "\t-r d: number of rows to average [20]\n"
+ "\t-a : remove average from each fft buffer\n"
+ "\t-s : input is stereo, channels will be combined before fft\n"
+ "16 bit machine format real input is assumed\n"
+ );
+ default:
+ fprintf (stderr, "bad %c\n", c);
+ exit (1);
+ break;
+ }
+ }
+ if ( optind < argc ) {
+ if (strcmp("-",argv[optind]) !=0)
+ fin = fopen(argv[optind],"rb");
+ ++optind;
+ }
+
+ if ( optind < argc ) {
+ if ( strcmp("-",argv[optind]) !=0 )
+ fout = fopen(argv[optind],"wb");
+ ++optind;
+ }
+ if (fin==NULL)
+ fin=stdin;
+ if (fout==NULL)
+ fout=stdout;
+}
+
+#define CHECKNULL(p) if ( (p)==NULL ) do { fprintf(stderr,"CHECKNULL failed @ %s(%d): %s\n",__FILE__,__LINE__,#p );exit(1);} while(0)
+
+typedef struct
+{
+ png_byte r;
+ png_byte g;
+ png_byte b;
+} rgb_t;
+
+static
+void val2rgb(float x,rgb_t *p)
+{
+ const double pi = 3.14159265358979;
+ p->g = (int)(255*sin(x*pi));
+ p->r = (int)(255*abs(sin(x*pi*3/2)));
+ p->b = (int)(255*abs(sin(x*pi*5/2)));
+ //fprintf(stderr,"%.2f : %d,%d,%d\n",x,(int)p->r,(int)p->g,(int)p->b);
+}
+
+static
+void cpx2pixels(rgb_t * res,const float * fbuf,size_t n)
+{
+ size_t i;
+ float minval,maxval,valrange;
+ minval=maxval=fbuf[0];
+
+ for (i = 0; i < n; ++i) {
+ if (fbuf[i] > maxval) maxval = fbuf[i];
+ if (fbuf[i] < minval) minval = fbuf[i];
+ }
+
+ fprintf(stderr,"min ==%f,max=%f\n",minval,maxval);
+ valrange = maxval-minval;
+ if (valrange == 0) {
+ fprintf(stderr,"min == max == %f\n",minval);
+ exit (1);
+ }
+
+ for (i = 0; i < n; ++i)
+ val2rgb( (fbuf[i] - minval)/valrange , res+i );
+}
+
+static
+void transform_signal(void)
+{
+ short *inbuf;
+ kiss_fftr_cfg cfg=NULL;
+ kiss_fft_scalar *tbuf;
+ kiss_fft_cpx *fbuf;
+ float *mag2buf;
+ int i;
+ int n;
+ int avgctr=0;
+
+ int nfreqs=nfft/2+1;
+
+ CHECKNULL( cfg=kiss_fftr_alloc(nfft,0,0,0) );
+ CHECKNULL( inbuf=(short*)malloc(sizeof(short)*2*nfft ) );
+ CHECKNULL( tbuf=(kiss_fft_scalar*)malloc(sizeof(kiss_fft_scalar)*nfft ) );
+ CHECKNULL( fbuf=(kiss_fft_cpx*)malloc(sizeof(kiss_fft_cpx)*nfreqs ) );
+ CHECKNULL( mag2buf=(float*)malloc(sizeof(float)*nfreqs ) );
+
+ memset(mag2buf,0,sizeof(mag2buf)*nfreqs);
+
+ while (1) {
+ if (stereo) {
+ n = fread(inbuf,sizeof(short)*2,nfft,fin);
+ if (n != nfft )
+ break;
+ for (i=0;i
+#include
+#include
+#include
+#include
+
+namespace {
+QReadWriteLock lock;
+QMutex mutex, fx_mutex;
+
+bool isFurtherLayer(const QPair val1,
+ const QPair val2) {
+ return val1.second > val2.second;
+}
+
+// FFT coordinate -> Normal corrdinate
+inline int getCoord(int i, int j, int lx, int ly) {
+ int cx = i - lx / 2;
+ int cy = j - ly / 2;
+
+ if (cx < 0) cx += lx;
+ if (cy < 0) cy += ly;
+
+ return cy * lx + cx;
+}
+
+// RGB value <--> Exposure
+inline float valueToExposure(float value, float filmGamma) {
+ float logVal = (value - 0.5) / filmGamma;
+ return pow(10, logVal);
+}
+inline float exposureToValue(float exposure, float filmGamma) {
+ return log10(exposure) * filmGamma + 0.5;
+}
+};
+
+//--------------------------------------------
+// Threads used for FFT computation for each RGB channel
+//--------------------------------------------
+
+MyThread::MyThread(Channel channel, TRasterP layerTileRas, TRasterP outTileRas,
+ TRasterP tmpAlphaRas, kiss_fft_cpx* kissfft_comp_iris,
+ float filmGamma,
+ bool doLightenComp) // not used for now
+ : m_channel(channel),
+ m_layerTileRas(layerTileRas),
+ m_outTileRas(outTileRas),
+ m_tmpAlphaRas(tmpAlphaRas),
+ m_kissfft_comp_iris(kissfft_comp_iris),
+ m_filmGamma(filmGamma),
+ m_finished(false),
+ m_kissfft_comp_in(0),
+ m_kissfft_comp_out(0),
+ m_isTerminated(false),
+ m_doLightenComp(doLightenComp) // not used for now
+{}
+
+bool MyThread::init() {
+ // get the source size
+ int lx, ly;
+ lx = m_layerTileRas->getSize().lx;
+ ly = m_layerTileRas->getSize().ly;
+
+ // memory allocation for input
+ m_kissfft_comp_in_ras = TRasterGR8P(lx * sizeof(kiss_fft_cpx), ly);
+ m_kissfft_comp_in_ras->lock();
+ m_kissfft_comp_in = (kiss_fft_cpx*)m_kissfft_comp_in_ras->getRawData();
+
+ // allocation check
+ if (m_kissfft_comp_in == 0) return false;
+
+ // cancel check
+ if (m_isTerminated) {
+ m_kissfft_comp_in_ras->unlock();
+ return false;
+ }
+
+ // memory allocation for output
+ m_kissfft_comp_out_ras = TRasterGR8P(lx * sizeof(kiss_fft_cpx), ly);
+ m_kissfft_comp_out_ras->lock();
+ m_kissfft_comp_out = (kiss_fft_cpx*)m_kissfft_comp_out_ras->getRawData();
+
+ // allocation check
+ if (m_kissfft_comp_out == 0) {
+ m_kissfft_comp_in_ras->unlock();
+ m_kissfft_comp_in = 0;
+ return false;
+ }
+
+ // cancel check
+ if (m_isTerminated) {
+ m_kissfft_comp_in_ras->unlock();
+ m_kissfft_comp_in = 0;
+ m_kissfft_comp_out_ras->unlock();
+ m_kissfft_comp_out = 0;
+ return false;
+ }
+
+ // create the forward FFT plan
+ int dims[2] = {ly, lx};
+ int ndims = 2;
+ m_kissfft_plan_fwd = kiss_fftnd_alloc(dims, ndims, false, 0, 0);
+ // allocation and cancel check
+ if (m_kissfft_plan_fwd == NULL || m_isTerminated) {
+ m_kissfft_comp_in_ras->unlock();
+ m_kissfft_comp_in = 0;
+ m_kissfft_comp_out_ras->unlock();
+ m_kissfft_comp_out = 0;
+ return false;
+ }
+
+ // create the backward FFT plan
+ m_kissfft_plan_bkwd = kiss_fftnd_alloc(dims, ndims, true, 0, 0);
+ // allocation and cancel check
+ if (m_kissfft_plan_bkwd == NULL || m_isTerminated) {
+ m_kissfft_comp_in_ras->unlock();
+ m_kissfft_comp_in = 0;
+ m_kissfft_comp_out_ras->unlock();
+ m_kissfft_comp_out = 0;
+ kiss_fft_free(m_kissfft_plan_fwd);
+ m_kissfft_plan_fwd = NULL;
+ return false;
+ }
+
+ // return true if all the initializations are done
+ return true;
+}
+
+//------------------------------------------------------------
+// Convert the pixels from RGB values to exposures and multiply it by alpha
+// channel value.
+// Store the results in the real part of kiss_fft_cpx.
+//------------------------------------------------------------
+template
+void MyThread::setLayerRaster(const RASTER srcRas, kiss_fft_cpx* dstMem,
+ TDimensionI dim) {
+ for (int j = 0; j < dim.ly; j++) {
+ PIXEL* pix = srcRas->pixels(j);
+ for (int i = 0; i < dim.lx; i++, pix++) {
+ if (pix->m != 0) {
+ float val = (m_channel == Red)
+ ? (float)pix->r
+ : (m_channel == Green) ? (float)pix->g : (float)pix->b;
+ // multiply the exposure by alpha channel value
+ dstMem[j * dim.lx + i].r =
+ valueToExposure(val / (float)PIXEL::maxChannelValue) *
+ ((float)pix->m / (float)PIXEL::maxChannelValue);
+ }
+ }
+ }
+}
+
+//------------------------------------------------------------
+// Composite the bokeh layer to the result
+//------------------------------------------------------------
+template
+void MyThread::compositLayerToTile(const RASTER layerRas,
+ const RASTER outTileRas,
+ const A_RASTER alphaRas, TDimensionI dim,
+ int2 margin) {
+ int j = margin.y;
+ for (int out_j = 0; out_j < outTileRas->getLy(); j++, out_j++) {
+ PIXEL* outPix = outTileRas->pixels(out_j);
+ A_PIXEL* alphaPix = alphaRas->pixels(j);
+
+ alphaPix += margin.x;
+
+ int i = margin.x;
+ for (int out_i = 0; out_i < outTileRas->getLx(); i++, out_i++) {
+ // If the layer pixel is transparent, keep the result pizel as-is.
+ float alpha = (float)alphaPix->value / (float)PIXEL::maxChannelValue;
+ if (alpha == 0.0f) {
+ alphaPix++;
+ outPix++;
+ continue;
+ }
+ // Composite the upper layer exposure with the bottom layers. Then,
+ // convert the exposure to RGB values.
+ PIXEL::Channel dnVal = (m_channel == Red)
+ ? outPix->r
+ : (m_channel == Green) ? outPix->g : outPix->b;
+
+ float exposure;
+ double val;
+ if (alpha == 1.0 || dnVal == 0.0) {
+ exposure = (m_kissfft_comp_in[getCoord(i, j, dim.lx, dim.ly)].r /
+ (dim.lx * dim.ly));
+ val = exposureToValue(exposure) * (float)PIXEL::maxChannelValue + 0.5f;
+ } else {
+ exposure =
+ (m_kissfft_comp_in[getCoord(i, j, dim.lx, dim.ly)].r /
+ (dim.lx * dim.ly)) +
+ valueToExposure((float)dnVal / (float)PIXEL::maxChannelValue) *
+ (1 - alpha);
+ val = exposureToValue(exposure) * (float)PIXEL::maxChannelValue + 0.5f;
+ // not used for now
+ if (m_doLightenComp) val = std::max(val, (double)dnVal);
+ }
+
+ // clamp
+ if (val < 0.0)
+ val = 0.0;
+ else if (val > (float)PIXEL::maxChannelValue)
+ val = (float)PIXEL::maxChannelValue;
+
+ switch (m_channel) {
+ case Red:
+ outPix->r = (PIXEL::Channel)val;
+ //"over" composite the alpha channel here
+ if (outPix->m != A_PIXEL::maxChannelValue) {
+ if (alphaPix->value == A_PIXEL::maxChannelValue)
+ outPix->m = A_PIXEL::maxChannelValue;
+ else
+ outPix->m = alphaPix->value +
+ (A_PIXEL::Channel)((float)outPix->m *
+ (float)(A_PIXEL::maxChannelValue -
+ alphaPix->value) /
+ (float)A_PIXEL::maxChannelValue);
+ }
+ break;
+ case Green:
+ outPix->g = (PIXEL::Channel)val;
+ break;
+ case Blue:
+ outPix->b = (PIXEL::Channel)val;
+ break;
+ }
+
+ alphaPix++;
+ outPix++;
+ }
+ }
+}
+
+//------------------------------------------------------------
+
+void MyThread::run() {
+ // get the source image size
+ TDimensionI dim = m_layerTileRas->getSize();
+
+ int2 margin = {(dim.lx - m_outTileRas->getSize().lx) / 2,
+ (dim.ly - m_outTileRas->getSize().ly) / 2};
+
+ // initialize
+ for (int i = 0; i < dim.lx * dim.ly; i++) {
+ m_kissfft_comp_in[i].r = 0.0; // real part
+ m_kissfft_comp_in[i].i = 0.0; // imaginary part
+ }
+
+ TRaster32P ras32 = (TRaster32P)m_layerTileRas;
+ TRaster64P ras64 = (TRaster64P)m_layerTileRas;
+ // Prepare data for FFT.
+ // Convert the RGB values to the exposure, then multiply it by the alpha
+ // channel value
+ {
+ lock.lockForRead();
+ if (ras32)
+ setLayerRaster(ras32, m_kissfft_comp_in, dim);
+ else if (ras64)
+ setLayerRaster(ras64, m_kissfft_comp_in, dim);
+ else {
+ lock.unlock();
+ return;
+ }
+
+ lock.unlock();
+ }
+
+ if (checkTerminationAndCleanupThread()) return;
+
+ kiss_fftnd(m_kissfft_plan_fwd, m_kissfft_comp_in, m_kissfft_comp_out);
+ kiss_fft_free(m_kissfft_plan_fwd); // we don't need this plan anymore
+ m_kissfft_plan_fwd = NULL;
+
+ if (checkTerminationAndCleanupThread()) return;
+
+ // Filtering. Multiply by the iris FFT data
+ {
+ for (int i = 0; i < dim.lx * dim.ly; i++) {
+ float re, im;
+ re = m_kissfft_comp_out[i].r * m_kissfft_comp_iris[i].r -
+ m_kissfft_comp_out[i].i * m_kissfft_comp_iris[i].i;
+ im = m_kissfft_comp_out[i].r * m_kissfft_comp_iris[i].i +
+ m_kissfft_comp_iris[i].r * m_kissfft_comp_out[i].i;
+ m_kissfft_comp_out[i].r = re;
+ m_kissfft_comp_out[i].i = im;
+ }
+ }
+
+ if (checkTerminationAndCleanupThread()) return;
+
+ kiss_fftnd(m_kissfft_plan_bkwd, m_kissfft_comp_out,
+ m_kissfft_comp_in); // Backward FFT
+ kiss_fft_free(m_kissfft_plan_bkwd); // we don't need this plan anymore
+ m_kissfft_plan_bkwd = NULL;
+
+ // In the backward FFT above, "m_kissfft_comp_out" is used as input and
+ // "m_kissfft_comp_in" as output.
+ // So we don't need "m_kissfft_comp_out" anymore.
+ m_kissfft_comp_out_ras->unlock();
+ m_kissfft_comp_out = 0;
+
+ if (checkTerminationAndCleanupThread()) return;
+
+ {
+ QMutexLocker locker(&mutex);
+
+ TRaster32P ras32 = (TRaster32P)m_layerTileRas;
+ TRaster64P ras64 = (TRaster64P)m_layerTileRas;
+
+ if (ras32) {
+ compositLayerToTile(
+ ras32, (TRaster32P)m_outTileRas, (TRasterGR8P)m_tmpAlphaRas, dim,
+ margin);
+ } else if (ras64) {
+ compositLayerToTile(
+ ras64, (TRaster64P)m_outTileRas, (TRasterGR16P)m_tmpAlphaRas, dim,
+ margin);
+ } else {
+ lock.unlock();
+ return;
+ }
+ }
+
+ // Now we don't need "m_kissfft_comp_in" anymore.
+ m_kissfft_comp_in_ras->unlock();
+ m_kissfft_comp_in = 0;
+
+ m_finished = true;
+}
+
+// RGB value <--> Exposure
+inline float MyThread::valueToExposure(float value) {
+ float logVal = (value - 0.5) / m_filmGamma;
+ return pow(10, logVal);
+}
+inline float MyThread::exposureToValue(float exposure) {
+ return log10(exposure) * m_filmGamma + 0.5;
+}
+
+// Release the raster memory and FFT plans on cancel rendering.
+bool MyThread::checkTerminationAndCleanupThread() {
+ if (!m_isTerminated) return false;
+
+ if (m_kissfft_comp_in) m_kissfft_comp_in_ras->unlock();
+ if (m_kissfft_comp_out) m_kissfft_comp_out_ras->unlock();
+ if (m_kissfft_plan_fwd) kiss_fft_free(m_kissfft_plan_fwd);
+ if (m_kissfft_plan_bkwd) kiss_fft_free(m_kissfft_plan_bkwd);
+
+ m_finished = true;
+ return true;
+}
+
+//--------------------------------------------
+// Iwa_BokehFx
+//--------------------------------------------
+
+Iwa_BokehFx::Iwa_BokehFx()
+ : m_onFocusDistance(0.5), m_bokehAmount(30.0), m_hardness(0.3) {
+ // Bind the common parameters
+ addInputPort("Iris", m_iris);
+ bindParam(this, "on_focus_distance", m_onFocusDistance, false);
+ bindParam(this, "bokeh_amount", m_bokehAmount, false);
+ bindParam(this, "hardness", m_hardness, false);
+
+ // Set the ranges of common parameters
+ m_onFocusDistance->setValueRange(0, 1);
+ m_bokehAmount->setValueRange(0, 300);
+ m_bokehAmount->setMeasureName("fxLength");
+ m_hardness->setValueRange(0.05, 3.0);
+
+ // Bind the layer parameters
+ for (int layer = 0; layer < LAYER_NUM; layer++) {
+ m_layerParams[layer].m_premultiply = TBoolParamP(false);
+ m_layerParams[layer].m_distance = TDoubleParamP(0.5);
+ m_layerParams[layer].m_bokehAdjustment = TDoubleParamP(1);
+
+ std::string str = QString("Source%1").arg(layer + 1).toStdString();
+ addInputPort(str, m_layerParams[layer].m_source);
+ bindParam(this, QString("premultiply%1").arg(layer + 1).toStdString(),
+ m_layerParams[layer].m_premultiply, false);
+ bindParam(this, QString("distance%1").arg(layer + 1).toStdString(),
+ m_layerParams[layer].m_distance, false);
+ bindParam(this, QString("bokeh_adjustment%1").arg(layer + 1).toStdString(),
+ m_layerParams[layer].m_bokehAdjustment, false);
+
+ m_layerParams[layer].m_distance->setValueRange(0, 1);
+ m_layerParams[layer].m_bokehAdjustment->setValueRange(0, 2);
+ }
+}
+
+void Iwa_BokehFx::doCompute(TTile& tile, double frame,
+ const TRenderSettings& settings) {
+ // If the iris is not connected, then do nothing
+ if (!m_iris.isConnected()) {
+ tile.getRaster()->clear();
+ return;
+ }
+ // If none of the source ports is connected, then do nothing
+ bool sourceIsConnected = false;
+ for (int i = 0; i < LAYER_NUM; i++) {
+ if (m_layerParams[i].m_source.isConnected()) {
+ sourceIsConnected = true;
+ break;
+ }
+ }
+ if (!sourceIsConnected) {
+ tile.getRaster()->clear();
+ return;
+ }
+
+ // Sort source layers by distance
+ QList sourceIndices = getSortedSourceIndices(frame);
+
+ // Get the pixel size of bokehAmount ( referenced ino_blur.cpp )
+ float bokehPixelAmount = getBokehPixelAmount(frame, settings.m_affine);
+
+ // Compute the bokeh size for each layer. The source tile will be enlarged by
+ // the largest size of them.
+ float maxIrisSize;
+ QVector irisSizes =
+ getIrisSizes(frame, sourceIndices, bokehPixelAmount, maxIrisSize);
+
+ int margin = tceil(maxIrisSize / 2.0);
+
+ // Range of computation
+ TRectD _rectOut(tile.m_pos, TDimensionD(tile.getRaster()->getLx(),
+ tile.getRaster()->getLy()));
+ _rectOut = _rectOut.enlarge(static_cast(margin));
+
+ TDimensionI dimOut(static_cast(_rectOut.getLx() + 0.5),
+ static_cast(_rectOut.getLy() + 0.5));
+
+ // Enlarge the size to the "fast size" for kissfft which has no factors other
+ // than 2,3, or 5.
+ if (dimOut.lx < 10000 && dimOut.ly < 10000) {
+ int new_x = kiss_fft_next_fast_size(dimOut.lx);
+ int new_y = kiss_fft_next_fast_size(dimOut.ly);
+
+ _rectOut = _rectOut.enlarge(static_cast(new_x - dimOut.lx) / 2.0,
+ static_cast(new_y - dimOut.ly) / 2.0);
+
+ dimOut.lx = new_x;
+ dimOut.ly = new_y;
+ }
+
+ //----------------------------
+ // Compute the input tiles first
+ QMap sourceTiles;
+ for (int i = 0; i < sourceIndices.size(); i++) {
+ int index = sourceIndices.at(i);
+ float irisSize = irisSizes.at(i);
+
+ TTile* layerTile = new TTile();
+ // Layer to be composited as-is
+ if (-1.0 <= irisSize && 1.0 >= irisSize) {
+ m_layerParams[index].m_source->allocateAndCompute(
+ *layerTile, tile.m_pos,
+ TDimension(tile.getRaster()->getLx(), tile.getRaster()->getLy()),
+ tile.getRaster(), frame, settings);
+ }
+ // Layer to be off-focused
+ else {
+ m_layerParams[index].m_source->allocateAndCompute(
+ *layerTile, _rectOut.getP00(), dimOut, tile.getRaster(), frame,
+ settings);
+ }
+ sourceTiles[index] = layerTile;
+ }
+
+ // Get the original size of Iris image
+ TRectD irisBBox;
+ m_iris->getBBox(frame, irisBBox, settings);
+ // Compute the iris tile.
+ TTile irisTile;
+ m_iris->allocateAndCompute(
+ irisTile, irisBBox.getP00(),
+ TDimension(static_cast(irisBBox.getLx() + 0.5),
+ static_cast(irisBBox.getLy() + 0.5)),
+ tile.getRaster(), frame, settings);
+
+ // This fx is relatively heavy so the multi thread computation is introduced.
+ // Lock the mutex here in order to prevent multiple rendering tasks run at the
+ // same time.
+ QMutexLocker fx_locker(&fx_mutex);
+
+ kiss_fft_cpx* kissfft_comp_iris;
+ // create the iris data for FFT (in the same size as the source tile)
+ TRasterGR8P kissfft_comp_iris_ras(dimOut.lx * sizeof(kiss_fft_cpx),
+ dimOut.ly);
+ kissfft_comp_iris_ras->lock();
+ kissfft_comp_iris = (kiss_fft_cpx*)kissfft_comp_iris_ras->getRawData();
+
+ // obtain the film gamma
+ double filmGamma = m_hardness->getValue(frame);
+
+ // clear the raster memory
+ tile.getRaster()->clear();
+ TRaster32P raster32 = tile.getRaster();
+ if (raster32)
+ raster32->fill(TPixel32::Transparent);
+ else {
+ TRaster64P ras64 = tile.getRaster();
+ if (ras64) ras64->fill(TPixel64::Transparent);
+ }
+
+ // cancel check
+ if (settings.m_isCanceled && *settings.m_isCanceled) {
+ kissfft_comp_iris_ras->unlock();
+ tile.getRaster()->clear();
+ return;
+ }
+
+ // Compute from from the most distant layer
+ for (int i = 0; i < sourceIndices.size(); i++) {
+ // cancel check
+ if (settings.m_isCanceled && *settings.m_isCanceled) {
+ kissfft_comp_iris_ras->unlock();
+ tile.getRaster()->clear();
+ return;
+ }
+
+ int index = sourceIndices.at(i);
+
+ // The iris size of the current layer
+ float irisSize = irisSizes.at(i);
+
+ // If the size of iris is less than 1 (i.e. the layer is at focal position),
+ // composite the layer as-is.
+ if (-1.0 <= irisSize && 1.0 >= irisSize) {
+ //"Over" composite the layer to the output raster.
+ TTile* layerTile = sourceTiles.value(index);
+ compositLayerAsIs(tile, *layerTile, frame, settings, index);
+ sourceTiles.remove(index);
+ // Continue to the next layer
+ continue;
+ }
+
+ {
+ // Create the Iris image for FFT
+ kiss_fft_cpx* kissfft_comp_iris_before;
+ TRasterGR8P kissfft_comp_iris_before_ras(dimOut.lx * sizeof(kiss_fft_cpx),
+ dimOut.ly);
+ kissfft_comp_iris_before_ras->lock();
+ kissfft_comp_iris_before =
+ (kiss_fft_cpx*)kissfft_comp_iris_before_ras->getRawData();
+ // Resize / flip the iris image according to the size ratio.
+ // Normalize the brightness of the iris image.
+ // Enlarge the iris to the output size.
+ convertIris(irisSize, kissfft_comp_iris_before, dimOut, irisBBox,
+ irisTile);
+
+ if (settings.m_isCanceled && *settings.m_isCanceled) {
+ kissfft_comp_iris_ras->unlock();
+ kissfft_comp_iris_before_ras->unlock();
+ tile.getRaster()->clear();
+ return;
+ }
+
+ // Create the FFT plan for the iris image.
+ kiss_fftnd_cfg iris_kissfft_plan;
+ while (1) {
+ int dims[2] = {dimOut.ly, dimOut.lx};
+ int ndims = 2;
+ iris_kissfft_plan = kiss_fftnd_alloc(dims, ndims, false, 0, 0);
+ if (iris_kissfft_plan != NULL) break;
+ }
+ // Do FFT the iris image.
+ kiss_fftnd(iris_kissfft_plan, kissfft_comp_iris_before,
+ kissfft_comp_iris);
+ kiss_fft_free(iris_kissfft_plan);
+ kissfft_comp_iris_before_ras->unlock();
+ }
+
+ // Up to here, FFT-ed iris data is stored in kissfft_comp_iris
+
+ // cancel check
+ if (settings.m_isCanceled && *settings.m_isCanceled) {
+ kissfft_comp_iris_ras->unlock();
+ tile.getRaster()->clear();
+ return;
+ }
+ // Prepare the layer rasters
+ TTile* layerTile = sourceTiles.value(index);
+ // Unpremultiply the source if needed
+ if (!m_layerParams[index].m_premultiply->getValue())
+ TRop::depremultiply(layerTile->getRaster());
+ // Create the raster memory for storing alpha channel
+ TRasterP tmpAlphaRas;
+ {
+ TRaster32P ras32(tile.getRaster());
+ TRaster64P ras64(tile.getRaster());
+ if (ras32)
+ tmpAlphaRas = TRasterGR8P(dimOut);
+ else if (ras64)
+ tmpAlphaRas = TRasterGR16P(dimOut);
+ }
+ tmpAlphaRas->lock();
+
+ // Do FFT the alpha channel.
+ // Forward FFT -> Multiply by the iris data -> Backward FFT
+ calcAlfaChannelBokeh(kissfft_comp_iris, *layerTile, tmpAlphaRas);
+
+ if (settings.m_isCanceled && *settings.m_isCanceled) {
+ kissfft_comp_iris_ras->unlock();
+ tile.getRaster()->clear();
+ tmpAlphaRas->unlock();
+ return;
+ }
+
+ // Create the threads for RGB channels
+ MyThread threadR(MyThread::Red, layerTile->getRaster(), tile.getRaster(),
+ tmpAlphaRas, kissfft_comp_iris, filmGamma);
+ MyThread threadG(MyThread::Green, layerTile->getRaster(), tile.getRaster(),
+ tmpAlphaRas, kissfft_comp_iris, filmGamma);
+ MyThread threadB(MyThread::Blue, layerTile->getRaster(), tile.getRaster(),
+ tmpAlphaRas, kissfft_comp_iris, filmGamma);
+
+ // If you set this flag to true, the fx will be forced to compute in single
+ // thread.
+ // Under some specific condition (such as calling from single-threaded
+ // tcomposer)
+ // we may need to use this flag... For now, I'll keep this option unused.
+ // TODO: investigate this.
+ bool renderInSingleThread = false;
+
+ // Start the thread when the initialization is done.
+ // Red channel
+ int waitCount = 0;
+ while (1) {
+ // cancel & timeout check
+ if ((settings.m_isCanceled && *settings.m_isCanceled) ||
+ waitCount >= 20) // 10 second timeout
+ {
+ kissfft_comp_iris_ras->unlock();
+ tile.getRaster()->clear();
+ tmpAlphaRas->unlock();
+ return;
+ }
+ if (threadR.init()) {
+ if (renderInSingleThread)
+ threadR.run();
+ else
+ threadR.start();
+ break;
+ }
+ Sleep(500);
+ waitCount++;
+ }
+ // Green channel
+ waitCount = 0;
+ while (1) {
+ // cancel & timeout check
+ if ((settings.m_isCanceled && *settings.m_isCanceled) ||
+ waitCount >= 20) // 10 second timeout
+ {
+ if (!threadR.isFinished()) threadR.terminateThread();
+ while (!threadR.isFinished()) {
+ }
+ kissfft_comp_iris_ras->unlock();
+ tile.getRaster()->clear();
+ tmpAlphaRas->unlock();
+ return;
+ }
+ if (threadG.init()) {
+ if (renderInSingleThread)
+ threadG.run();
+ else
+ threadG.start();
+ break;
+ }
+ Sleep(500);
+ waitCount++;
+ }
+ // Blue channel
+ waitCount = 0;
+ while (1) {
+ // cancel & timeout check
+ if ((settings.m_isCanceled && *settings.m_isCanceled) ||
+ waitCount >= 20) // 10 second timeout
+ {
+ if (!threadR.isFinished()) threadR.terminateThread();
+ if (!threadG.isFinished()) threadG.terminateThread();
+ while (!threadR.isFinished() || !threadG.isFinished()) {
+ }
+ kissfft_comp_iris_ras->unlock();
+ tile.getRaster()->clear();
+ tmpAlphaRas->unlock();
+ return;
+ }
+ if (threadB.init()) {
+ if (renderInSingleThread)
+ threadB.run();
+ else
+ threadB.start();
+ break;
+ }
+ Sleep(500);
+ waitCount++;
+ }
+
+ /*
+ * What is done in the thread for each RGB channel:
+ * - Convert channel value -> Exposure
+ * - Multiply by alpha channel
+ * - Forward FFT
+ * - Multiply by the iris FFT data
+ * - Backward FFT
+ * - Convert Exposure -> channel value
+ */
+
+ waitCount = 0;
+ while (1) {
+ // cancel & timeout check
+ if ((settings.m_isCanceled && *settings.m_isCanceled) ||
+ waitCount >= 2000) // 100 second timeout
+ {
+ if (!threadR.isFinished()) threadR.terminateThread();
+ if (!threadG.isFinished()) threadG.terminateThread();
+ if (!threadB.isFinished()) threadB.terminateThread();
+ while (!threadR.isFinished() || !threadG.isFinished() ||
+ !threadB.isFinished()) {
+ }
+ kissfft_comp_iris_ras->unlock();
+ tile.getRaster()->clear();
+ tmpAlphaRas->unlock();
+ return;
+ }
+ if (threadR.isFinished() && threadG.isFinished() && threadB.isFinished())
+ break;
+ Sleep(50);
+ waitCount++;
+ }
+ tmpAlphaRas->unlock();
+ sourceTiles.remove(index);
+ }
+
+ kissfft_comp_iris_ras->unlock();
+}
+
+bool Iwa_BokehFx::doGetBBox(double frame, TRectD& bBox,
+ const TRenderSettings& info) {
+ bBox = TConsts::infiniteRectD;
+ return true;
+}
+
+bool Iwa_BokehFx::canHandle(const TRenderSettings& info, double frame) {
+ return false;
+}
+
+// Sort the layers by distances
+QList Iwa_BokehFx::getSortedSourceIndices(double frame) {
+ QList> usedSourceList;
+
+ // Gather the source layers connected to the ports
+ for (int i = 0; i < LAYER_NUM; i++) {
+ if (m_layerParams[i].m_source.isConnected())
+ usedSourceList.push_back(
+ QPair(i, m_layerParams[i].m_distance->getValue(frame)));
+ }
+
+ if (usedSourceList.empty()) return QList();
+
+ // Sort the layers in descending distance order
+ qSort(usedSourceList.begin(), usedSourceList.end(), isFurtherLayer);
+
+ QList indicesList;
+ for (int i = 0; i < usedSourceList.size(); i++) {
+ indicesList.push_back(usedSourceList.at(i).first);
+ }
+
+ return indicesList;
+}
+
+// Get the pixel size of bokehAmount ( referenced ino_blur.cpp )
+float Iwa_BokehFx::getBokehPixelAmount(const double frame,
+ const TAffine affine) {
+ /*--- Convert to vector --- */
+ TPointD vect;
+ vect.x = m_bokehAmount->getValue(frame);
+ vect.y = 0.0;
+ /*--- Apply geometrical transformation ---*/
+ /* ȉ́A
+ N:/admin/toonzsrc/m-inoue/tnz6100sp1_ino0011/ghibli/toonz/main/sources/stdfx/motionblurfx.cpp
+ 586-592sQƂď
+ */
+ TAffine aff(affine);
+ aff.a13 = aff.a23 = 0; /* ignore translation */
+ vect = aff * vect;
+ /*--- return the length of the vector ---*/
+ return sqrt(vect.x * vect.x + vect.y * vect.y);
+}
+
+// Compute the bokeh size for each layer. The source tile will be enlarged by
+// the largest size of them.
+QVector Iwa_BokehFx::getIrisSizes(const double frame,
+ const QList sourceIndices,
+ const float bokehPixelAmount,
+ float& maxIrisSize) {
+ float max = 0.0;
+ QVector irisSizes;
+ for (int s = 0; s < sourceIndices.size(); s++) {
+ int index = sourceIndices.at(s);
+ float irisSize = (m_onFocusDistance->getValue(frame) -
+ m_layerParams[index].m_distance->getValue(frame)) *
+ bokehPixelAmount *
+ m_layerParams[index].m_bokehAdjustment->getValue(frame);
+ irisSizes.push_back(irisSize);
+
+ // Update the maximum size
+ if (max < fabs(irisSize)) max = fabs(irisSize);
+ }
+ maxIrisSize = max;
+
+ return irisSizes;
+}
+
+//"Over" composite the layer to the output raster.
+void Iwa_BokehFx::compositLayerAsIs(TTile& tile, TTile& layerTile,
+ const double frame,
+ const TRenderSettings& settings,
+ const int index) {
+ // Premultiply the source if needed
+ if (m_layerParams[index].m_premultiply->getValue())
+ TRop::premultiply(layerTile.getRaster());
+
+ TRop::over(tile.getRaster(), layerTile.getRaster());
+}
+
+//------------------------------------------------
+// Resize / flip the iris image according to the size ratio.
+// Normalize the brightness of the iris image.
+// Enlarge the iris to the output size.
+void Iwa_BokehFx::convertIris(const float irisSize,
+ kiss_fft_cpx* kissfft_comp_iris_before,
+ const TDimensionI& dimOut, const TRectD& irisBBox,
+ const TTile& irisTile) {
+ // the original size of iris image
+ double2 irisOrgSize = {irisBBox.getLx(), irisBBox.getLy()};
+
+ // Get the size ratio of iris based on width. The ratio can be negative value.
+ double irisSizeResampleRatio = irisSize / irisOrgSize.x;
+
+ // Create the raster for resized iris
+ double2 resizedIrisSize = {abs(irisSizeResampleRatio) * irisOrgSize.x,
+ abs(irisSizeResampleRatio) * irisOrgSize.y};
+ int2 filterSize = {tceil(resizedIrisSize.x), tceil(resizedIrisSize.y)};
+ TPointD resizeOffset((double)filterSize.x - resizedIrisSize.x,
+ (double)filterSize.y - resizedIrisSize.y);
+
+ // Add some adjustment in order to absorb the difference of the cases when the
+ // iris size is odd and even numbers.
+ bool isIrisOffset[2] = {false, false};
+ // Try to set the center of the iris to the center of the screen
+ if ((dimOut.lx - filterSize.x) % 2 == 1) {
+ filterSize.x++;
+ isIrisOffset[0] = true;
+ }
+ if ((dimOut.ly - filterSize.y) % 2 == 1) {
+ filterSize.y++;
+ isIrisOffset[1] = true;
+ }
+
+ // Terminate if the filter size becomes bigger than the output size.
+ if (filterSize.x > dimOut.lx || filterSize.y > dimOut.ly) {
+ std::cout
+ << "Error: The iris filter size becomes larger than the source size!"
+ << std::endl;
+ return;
+ }
+
+ TRaster64P resizedIris(TDimension(filterSize.x, filterSize.y));
+
+ // Add some adjustment in order to absorb the 0.5 translation to be done in
+ // resample()
+ TAffine aff;
+ TPointD affOffset((isIrisOffset[0]) ? 0.5 : 1.0,
+ (isIrisOffset[1]) ? 0.5 : 1.0);
+ if (!isIrisOffset[0]) affOffset.x -= resizeOffset.x / 2;
+ if (!isIrisOffset[1]) affOffset.y -= resizeOffset.y / 2;
+
+ aff = TTranslation(resizedIris->getCenterD() + affOffset);
+ aff *= TScale(irisSizeResampleRatio);
+ aff *= TTranslation(-(irisTile.getRaster()->getCenterD() + affOffset));
+
+ // resample the iris
+ TRop::resample(resizedIris, irisTile.getRaster(), aff);
+
+ // accumulated value
+ float irisValAmount = 0.0;
+
+ int iris_j = 0;
+ // Initialize
+ for (int i = 0; i < dimOut.lx * dimOut.ly; i++) {
+ kissfft_comp_iris_before[i].r = 0.0;
+ kissfft_comp_iris_before[i].i = 0.0;
+ }
+ for (int j = (dimOut.ly - filterSize.y) / 2; iris_j < filterSize.y;
+ j++, iris_j++) {
+ TPixel64* pix = resizedIris->pixels(iris_j);
+ int iris_i = 0;
+ for (int i = (dimOut.lx - filterSize.x) / 2; iris_i < filterSize.x;
+ i++, iris_i++) {
+ // Value = 0.3R 0.59G 0.11B
+ kissfft_comp_iris_before[j * dimOut.lx + i].r =
+ ((float)pix->r * 0.3f + (float)pix->g * 0.59f +
+ (float)pix->b * 0.11f) /
+ (float)USHRT_MAX;
+ irisValAmount += kissfft_comp_iris_before[j * dimOut.lx + i].r;
+ pix++;
+ }
+ }
+
+ // Normalize value
+ for (int i = 0; i < dimOut.lx * dimOut.ly; i++) {
+ kissfft_comp_iris_before[i].r /= irisValAmount;
+ }
+}
+
+// Do FFT the alpha channel.
+// Forward FFT -> Multiply by the iris data -> Backward FFT
+void Iwa_BokehFx::calcAlfaChannelBokeh(kiss_fft_cpx* kissfft_comp_iris,
+ TTile& layerTile, TRasterP tmpAlphaRas) {
+ // Obtain the source size
+ int lx, ly;
+ lx = layerTile.getRaster()->getSize().lx;
+ ly = layerTile.getRaster()->getSize().ly;
+
+ // Allocate the FFT data
+ kiss_fft_cpx *kissfft_comp_in, *kissfft_comp_out;
+
+ TRasterGR8P kissfft_comp_in_ras(lx * sizeof(kiss_fft_cpx), ly);
+ kissfft_comp_in_ras->lock();
+ kissfft_comp_in = (kiss_fft_cpx*)kissfft_comp_in_ras->getRawData();
+ TRasterGR8P kissfft_comp_out_ras(lx * sizeof(kiss_fft_cpx), ly);
+ kissfft_comp_out_ras->lock();
+ kissfft_comp_out = (kiss_fft_cpx*)kissfft_comp_out_ras->getRawData();
+
+ // Initialize the FFT data
+ for (int i = 0; i < lx * ly; i++) {
+ kissfft_comp_in[i].r = 0.0; // real part
+ kissfft_comp_in[i].i = 0.0; // imaginary part
+ }
+
+ TRaster32P ras32 = (TRaster32P)layerTile.getRaster();
+ TRaster64P ras64 = (TRaster64P)layerTile.getRaster();
+ if (ras32) {
+ for (int j = 0; j < ly; j++) {
+ TPixel32* pix = ras32->pixels(j);
+ for (int i = 0; i < lx; i++) {
+ kissfft_comp_in[j * lx + i].r = (float)pix->m / (float)UCHAR_MAX;
+ pix++;
+ }
+ }
+ } else if (ras64) {
+ for (int j = 0; j < ly; j++) {
+ TPixel64* pix = ras64->pixels(j);
+ for (int i = 0; i < lx; i++) {
+ kissfft_comp_in[j * lx + i].r = (float)pix->m / (float)USHRT_MAX;
+ pix++;
+ }
+ }
+ } else
+ return;
+
+ int dims[2] = {ly, lx};
+ int ndims = 2;
+ kiss_fftnd_cfg plan_fwd = kiss_fftnd_alloc(dims, ndims, false, 0, 0);
+ kiss_fftnd(plan_fwd, kissfft_comp_in, kissfft_comp_out);
+ kiss_fft_free(plan_fwd); // we don't need this plan anymore
+
+ // Filtering. Multiply by the iris FFT data
+ for (int i = 0; i < lx * ly; i++) {
+ float re, im;
+ re = kissfft_comp_out[i].r * kissfft_comp_iris[i].r -
+ kissfft_comp_out[i].i * kissfft_comp_iris[i].i;
+ im = kissfft_comp_out[i].r * kissfft_comp_iris[i].i +
+ kissfft_comp_iris[i].r * kissfft_comp_out[i].i;
+ kissfft_comp_out[i].r = re;
+ kissfft_comp_out[i].i = im;
+ }
+
+ kiss_fftnd_cfg plan_bkwd = kiss_fftnd_alloc(dims, ndims, true, 0, 0);
+ kiss_fftnd(plan_bkwd, kissfft_comp_out, kissfft_comp_in); // Backward FFT
+ kiss_fft_free(plan_bkwd); // we don't need this plan anymore
+
+ // In the backward FFT above, "kissfft_comp_out" is used as input and
+ // "kissfft_comp_in" as output.
+ // So we don't need "kissfft_comp_out" anymore.
+ kissfft_comp_out_ras->unlock();
+
+ // Store the result into the alpha channel of layer tile
+ if (ras32) {
+ TRasterGR8P alphaRas8(tmpAlphaRas);
+ for (int j = 0; j < ly; j++) {
+ TPixelGR8* pix = alphaRas8->pixels(j);
+ for (int i = 0; i < lx; i++) {
+ float val =
+ kissfft_comp_in[getCoord(i, j, lx, ly)].r / (lx * ly) * 256.0;
+ if (val < 0.0)
+ val = 0.0;
+ else if (val > 255.0)
+ val = 255.0;
+
+ pix->value = (unsigned char)val;
+
+ pix++;
+ }
+ }
+ } else if (ras64) {
+ TRasterGR16P alphaRas16(tmpAlphaRas);
+ for (int j = 0; j < ly; j++) {
+ TPixelGR16* pix = alphaRas16->pixels(j);
+ for (int i = 0; i < lx; i++) {
+ float val =
+ kissfft_comp_in[getCoord(i, j, lx, ly)].r / (lx * ly) * 65536.0;
+ if (val < 0.0)
+ val = 0.0;
+ else if (val > 65535.0)
+ val = 65535.0;
+
+ pix->value = (unsigned short)val;
+
+ pix++;
+ }
+ }
+ } else
+ return;
+
+ kissfft_comp_in_ras->unlock();
+}
+
+FX_PLUGIN_IDENTIFIER(Iwa_BokehFx, "iwa_BokehFx")
\ No newline at end of file
diff --git a/toonz/sources/stdfx/iwa_bokehfx.h b/toonz/sources/stdfx/iwa_bokehfx.h
new file mode 100644
index 00000000..c0cdf966
--- /dev/null
+++ b/toonz/sources/stdfx/iwa_bokehfx.h
@@ -0,0 +1,149 @@
+#pragma once
+
+/*------------------------------------
+Iwa_BokehFx
+Apply an off-focus effect to the source image, using user input iris image.
+It considers characteristics of films (which is known as Hurter–Driffield
+curves)
+or human eye's perception (which is known as Weber–Fechner law).
+For filtering process I used KissFFT, an FFT library by Mark Borgerding,
+distributed with a 3-clause BSD-style license.
+------------------------------------*/
+
+#ifndef IWA_BOKEHFX_H
+#define IWA_BOKEHFX_H
+
+#include "stdfx.h"
+#include "tfxparam.h"
+#include "traster.h"
+
+#include
+#include
+
+#include "tools/kiss_fftnd.h"
+
+const int LAYER_NUM = 5;
+
+struct double2 {
+ double x, y;
+};
+struct int2 {
+ int x, y;
+};
+
+class MyThread : public QThread {
+public:
+ enum Channel { Red = 0, Green, Blue };
+
+private:
+ Channel m_channel;
+
+ volatile bool m_finished;
+
+ TRasterP m_layerTileRas;
+ TRasterP m_outTileRas;
+ TRasterP m_tmpAlphaRas;
+
+ kiss_fft_cpx *m_kissfft_comp_iris;
+
+ float m_filmGamma; // keep the film gamma in each thread as it is refered so
+ // often
+
+ TRasterGR8P m_kissfft_comp_in_ras, m_kissfft_comp_out_ras;
+ kiss_fft_cpx *m_kissfft_comp_in, *m_kissfft_comp_out;
+ kiss_fftnd_cfg m_kissfft_plan_fwd, m_kissfft_plan_bkwd;
+
+ bool m_isTerminated;
+
+ // not used for now
+ bool m_doLightenComp;
+
+public:
+ MyThread(Channel channel, TRasterP layerTileRas, TRasterP outTileRas,
+ TRasterP tmpAlphaRas, kiss_fft_cpx *kissfft_comp_iris,
+ float m_filmGamma,
+ bool doLightenComp = false); // not used for now
+
+ // Convert the pixels from RGB values to exposures and multiply it by alpha
+ // channel value.
+ // Store the results in the real part of kiss_fft_cpx.
+ template
+ void setLayerRaster(const RASTER srcRas, kiss_fft_cpx *dstMem,
+ TDimensionI dim);
+
+ // Composite the bokeh layer to the result
+ template
+ void compositLayerToTile(const RASTER layerRas, const RASTER outTileRas,
+ const A_RASTER alphaRas, TDimensionI dim,
+ int2 margin);
+ void run();
+
+ bool isFinished() { return m_finished; }
+
+ // RGB value <--> Exposure
+ float valueToExposure(float value);
+ float exposureToValue(float exposure);
+
+ // memory allocation
+ bool init();
+
+ void terminateThread() { m_isTerminated = true; }
+
+ bool checkTerminationAndCleanupThread();
+};
+
+class Iwa_BokehFx : public TStandardRasterFx {
+ FX_PLUGIN_DECLARATION(Iwa_BokehFx)
+
+protected:
+ TRasterFxPort m_iris;
+ TDoubleParamP m_onFocusDistance; // Focus Distance (0-1)
+ TDoubleParamP m_bokehAmount; // The maximum bokeh size. The size of bokeh at
+ // the layer separated by 1.0 from the focal
+ // position
+ TDoubleParamP m_hardness; // Film gamma
+
+ struct LAYERPARAM {
+ TRasterFxPort m_source;
+ TBoolParamP m_premultiply;
+ TDoubleParamP m_distance; // The layer distance from the camera (0-1)
+ TDoubleParamP m_bokehAdjustment; // Factor for adjusting distance (= focal
+ // distance - layer distance) (0-2.0)
+ } m_layerParams[LAYER_NUM];
+
+ // Sort source layers by distance
+ QList getSortedSourceIndices(double frame);
+ // Get the pixel size of bokehAmount ( referenced ino_blur.cpp )
+ float getBokehPixelAmount(const double frame, const TAffine affine);
+ // Compute the bokeh size for each layer. The source tile will be enlarged by
+ // the largest size of them.
+ QVector getIrisSizes(const double frame,
+ const QList sourceIndices,
+ const float bokehPixelAmount, float &maxIrisSize);
+ //"Over" composite the layer to the output raster.
+ void compositLayerAsIs(TTile &tile, TTile &layerTile, const double frame,
+ const TRenderSettings &settings, const int index);
+ // Resize / flip the iris image according to the size ratio.
+ // Normalize the brightness of the iris image.
+ // Enlarge the iris to the output size.
+ void convertIris(const float irisSize, kiss_fft_cpx *kissfft_comp_iris_before,
+ const TDimensionI &dimOut, const TRectD &irisBBox,
+ const TTile &irisTile);
+
+ // Do FFT the alpha channel.
+ // Forward FFT -> Multiply by the iris data -> Backward FFT
+ void calcAlfaChannelBokeh(kiss_fft_cpx *kissfft_comp_iris, TTile &layerTile,
+ TRasterP tmpAlphaRas);
+
+public:
+ Iwa_BokehFx();
+
+ void doCompute(TTile &tile, double frame, const TRenderSettings &settings);
+
+ bool doGetBBox(double frame, TRectD &bBox, const TRenderSettings &info);
+
+ bool canHandle(const TRenderSettings &info, double frame);
+};
+
+#endif
\ No newline at end of file
diff --git a/toonz/sources/toonzqt/Resources/fxicons/fx_iwa_bokeh.png b/toonz/sources/toonzqt/Resources/fxicons/fx_iwa_bokeh.png
new file mode 100644
index 00000000..e4a97cf1
Binary files /dev/null and b/toonz/sources/toonzqt/Resources/fxicons/fx_iwa_bokeh.png differ
diff --git a/toonz/sources/toonzqt/Resources/fxicons/fx_iwa_soapbubble.png b/toonz/sources/toonzqt/Resources/fxicons/fx_iwa_soapbubble.png
new file mode 100644
index 00000000..2b018675
Binary files /dev/null and b/toonz/sources/toonzqt/Resources/fxicons/fx_iwa_soapbubble.png differ
diff --git a/toonz/sources/toonzqt/toonzqt.qrc b/toonz/sources/toonzqt/toonzqt.qrc
index 0ec17304..6fc19a11 100644
--- a/toonz/sources/toonzqt/toonzqt.qrc
+++ b/toonz/sources/toonzqt/toonzqt.qrc
@@ -296,6 +296,8 @@
Resources/fxicons/fx_iwa_spectrum.png
Resources/fxicons/fx_iwa_perspective_distort.png
Resources/fxicons/fx_iwa_pn_perspective.png
+ Resources/fxicons/fx_iwa_bokeh.png
+ Resources/fxicons/fx_iwa_soapbubble.png
Resources/fxicons/fx_unidentified.png
Resources/keyframe_noanim.png
Resources/keyframe_key.png