From 79096fd626b946efd6947fa94ab15d30bf003ba0 Mon Sep 17 00:00:00 2001 From: Hans-Christoph Steiner Date: Thu, 19 Aug 2010 05:04:28 +0000 Subject: converted to new library template and debianized svn path=/trunk/externals/ekext/; revision=13835 --- peakit~.c | 147 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 147 insertions(+) create mode 100644 peakit~.c (limited to 'peakit~.c') diff --git a/peakit~.c b/peakit~.c new file mode 100644 index 0000000..8fd5f9a --- /dev/null +++ b/peakit~.c @@ -0,0 +1,147 @@ +/* peakit~ - find frequencies and magnitudes of FFT peaks + * Copyright (C) 2005 Edward Kelly + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + */ + +#include "m_pd.h" +#include +#include + +static t_class *peakit_tilde_class; + +typedef struct _bin_store +{ + t_atom peaks[2048]; + t_atom indices[2048]; + t_atom theta[4096]; + t_atom t_prev[4096]; + t_atom t_delta[4096]; + t_atom peakfreqs[2048]; + t_float *f_real, *f_imag; +} t_bin_store; + +typedef struct _peakit_tilde +{ + t_object x_obj; + t_bin_store x_ctl; + t_int minmeth; + t_outlet *peaks_list, *mags_list; + t_float f_npeaks, f_minmag, f_dummy; +} t_peakit_tilde; + +t_int *peakit_tilde_perform(t_int *w) +{ + t_peakit_tilde *x = (t_peakit_tilde *)(w[1]); + t_bin_store *store = (t_bin_store *)(w[2]); + t_sample *profile = (t_sample *)(w[3]); + int n = (int)(w[4]); + t_float *real = store->f_real; + t_float *imag = store->f_imag; + int vector = n; + float s_rate = sys_getsr(); + float bin = s_rate/n; + float boff = bin/2; + float inexp; + float interp; + float minus_two = 0; + float minus_one = 0; + float alpha = 0; + float peakfreq; + float theta = 0; + float t_prev = 0; + float t_delta; + float pi=M_PI; + float twopi=2*pi; + t_int npeaks = 0; + int i, ndx; + + /* find peaks in fourier series */ + for (i = 0; i < n; i++) + { + alpha = sqrt(real[i] * real[i] + imag[i] * imag[i]); + theta = atan2(real[i], imag[i]); + t_prev = atom_getfloatarg(i, 16384, store->theta); + SETFLOAT (&store->t_prev[i], t_prev); + SETFLOAT (&store->theta[i], theta); + t_delta = (atom_getfloatarg(i, 16384, store->theta))-(atom_getfloatarg(i, 16384, store->t_prev)); + SETFLOAT (&store->t_delta[i], t_delta); + inexp = x->f_minmag * 1-(0.1*(log10(boff+i*bin))); + if (minus_twox->f_minmag && x->minmeth == 0) + { + SETFLOAT (&store->peaks[npeaks],minus_one); + SETFLOAT (&store->indices[npeaks],i-1); + npeaks++; + } + else if (minus_twox->f_minmag && x->minmeth == 0) + minus_two = minus_one; + minus_one = alpha; + } + for (i = 0; i < npeaks; i++) + { + ndx = atom_getfloatarg(i, 8192, store->indices); + t_delta = atom_getfloatarg(ndx, 16384, store->t_delta); + theta = atom_getfloatarg(ndx, 8192, store->theta); + t_prev = atom_getfloatarg(ndx, 8192, store->t_prev); + t_delta = (t_delta < -pi) ? (theta+twopi)-t_prev : (t_delta > pi) ? theta-(t_prev+twopi) : t_delta; + peakfreq = (ndx * bin + (boff * -(t_delta/pi))); + SETFLOAT (&store->peakfreqs[i], peakfreq); + } + outlet_list(x->mags_list, gensym("list"), (npeaks - 1), store->peaks); + outlet_list(x->peaks_list, gensym("list"), (npeaks - 1), store->peakfreqs); + return(w+5); +} + +void peakit_tilde_iexp(t_peakit_tilde *x, t_floatarg f) +{ + x->minmeth = f; +} + +void *peakit_tilde_dsp(t_peakit_tilde *x, t_signal **sp) +{ + x->x_ctl.f_real = sp[0]->s_vec; + x->x_ctl.f_imag = sp[1]->s_vec; + dsp_add(peakit_tilde_perform, 4, x, &x->x_ctl, sp[0]->s_vec, sp[0]->s_n); + return (void *)x; +} + +void *peakit_tilde_new(t_floatarg f) +{ + t_peakit_tilde *x = (t_peakit_tilde *)pd_new(peakit_tilde_class); + x->f_minmag = f; + x->minmeth = 0; + memset(x->x_ctl.theta, 0, 8192); + inlet_new(&x->x_obj, &x->x_obj.ob_pd, &s_signal, &s_signal); + floatinlet_new(&x->x_obj, &x->f_minmag); + x->peaks_list = outlet_new(&x->x_obj, &s_list); + x->mags_list = outlet_new(&x->x_obj, &s_list); + return (void *)x; +} + +void peakit_tilde_setup(void) +{ + peakit_tilde_class = class_new(gensym("peakit~"), + (t_newmethod)peakit_tilde_new, + 0, sizeof(t_peakit_tilde), + CLASS_DEFAULT, A_DEFFLOAT, 0); + + post("|--<>---<>---<>--<>---<>--|"); + post("|---<>--<>---<>----|"); + post("|-<>-----<>-<2005>--|"); + + + class_addmethod(peakit_tilde_class, (t_method)peakit_tilde_dsp, gensym("dsp"), 0); + class_addmethod(peakit_tilde_class, (t_method)peakit_tilde_iexp, &s_float, A_DEFFLOAT, 0); + CLASS_MAINSIGNALIN(peakit_tilde_class, t_peakit_tilde, f_dummy); +} -- cgit v1.2.1