diff options
Diffstat (limited to 'src/spec2_matrix_bundle_stat~.c')
| -rw-r--r-- | src/spec2_matrix_bundle_stat~.c | 285 |
1 files changed, 285 insertions, 0 deletions
diff --git a/src/spec2_matrix_bundle_stat~.c b/src/spec2_matrix_bundle_stat~.c new file mode 100644 index 0000000..ebba2dd --- /dev/null +++ b/src/spec2_matrix_bundle_stat~.c @@ -0,0 +1,285 @@ +/* For information on usage and redistribution, and for a DISCLAIMER OF ALL +* WARRANTIES, see the file, "LICENSE.txt," in this distribution. + +iem_spec2 written by Thomas Musil, Copyright (c) IEM KUG Graz Austria 2000 - 2006 */ + +#include "m_pd.h" +#include "iemlib.h" + +/* ---------- spec2_matrix_bundle_stat~ - signal matrix multiplication object with message matrix-coeff. ----------- */ + +typedef struct spec2_matrix_bundle_stat_tilde +{ + t_object x_obj; + int *x_matbuf; + t_float **x_io; + t_float *x_outsumbuf; + int x_outsumbufsize; + int x_n_in; /* columns */ + int x_n_out; /* rows */ + t_float x_msi; +} t_spec2_matrix_bundle_stat_tilde; + +t_class *spec2_matrix_bundle_stat_tilde_class; + +static void spec2_matrix_bundle_stat_tilde_element(t_spec2_matrix_bundle_stat_tilde *x, t_symbol *s, int argc, t_atom *argv) +{ + int inindex, outindex; + int *matrix = x->x_matbuf; + + if(argc < 2) + { + post("spec2_matrix_bundle_stat~ : bad list: <int> output_row_index <int> input_col_index !"); + return; + } + + outindex = (int)atom_getint(argv); + argv++; + inindex = (int)atom_getint(argv) - 1; + + if(inindex >= x->x_n_in) + inindex = x->x_n_in - 1; + if(inindex < 0) + inindex = 0; + if(outindex >= x->x_n_out) + outindex = x->x_n_out; + if(outindex < 0) + outindex = 0; + + matrix[inindex] = outindex; +} + +static void spec2_matrix_bundle_stat_tilde_list(t_spec2_matrix_bundle_stat_tilde *x, t_symbol *s, int argc, t_atom *argv) +{ + int outindex, i, n=x->x_n_in; + int *matrix = x->x_matbuf; + + if(argc < n) + { + post("spec2_matrix_bundle_stat~ : bad list: (number_of_input_cols = %d) * <int> output_row_index !", n); + return; + } + + for(i=0; i<n; i++) + { + outindex = (int)atom_getint(argv); + argv++; + if(outindex >= x->x_n_out) + outindex = x->x_n_out; + if(outindex < 0) + outindex = 0; + matrix[i] = outindex; + } +} + +static void spec2_matrix_bundle_stat_tilde_bundle(t_spec2_matrix_bundle_stat_tilde *x, t_symbol *s, int argc, t_atom *argv) +{ + spec2_matrix_bundle_stat_tilde_list(x, &s_list, argc, argv); +} + +/* the dsp thing */ + +static t_int *spec2_matrix_bundle_stat_tilde_perform(t_int *w) +{ + t_spec2_matrix_bundle_stat_tilde *x = (t_spec2_matrix_bundle_stat_tilde *)(w[1]); + int n = (int)(w[2]); + + t_float **io = x->x_io; + t_float *outsum; + int *mat = x->x_matbuf; + int n_in = x->x_n_in; /* columns */ + int n_out = x->x_n_out; /* rows */ + t_float *in, *out; + int i, j, thrw; + + outsum = x->x_outsumbuf; + for(j=0; j<n_out; j++)/* reset out-buffer */ + { + for(i=0; i<=n; i++) + *outsum++ = 0.0f; + } + + for(j=0; j<n_in; j++)/* each in */ + { + in = io[j]; + thrw = mat[j]; + if(thrw) + { + thrw--; + outsum = x->x_outsumbuf + n*thrw; + for(i=0; i<=n; i++) + *outsum++ += *in++; + } + } + + outsum = x->x_outsumbuf; + for(j=0; j<n_out; j++)/* copy out-buffer to out */ + { + out = io[n_in+j]; + for(i=0; i<=n; i++) + *out++ = *outsum++; + } + return (w+3); +} + +static t_int *spec2_matrix_bundle_stat_tilde_perf8(t_int *w) +{ + t_spec2_matrix_bundle_stat_tilde *x = (t_spec2_matrix_bundle_stat_tilde *)(w[1]); + int n = (int)(w[2]); + + t_float **io = x->x_io; + t_float *outsum; + int *mat = x->x_matbuf; + int n_in = x->x_n_in; /* columns */ + int n_out = x->x_n_out; /* rows */ + t_float *in, *out; + int i, j, thrw; + + for(j=0; j<n_out; j++)/* reset out-buffer */ + { + outsum = x->x_outsumbuf + j*(n+1); + for(i=n; i; i -= 8, outsum += 8) + { + outsum[0] = 0.0f; + outsum[1] = 0.0f; + outsum[2] = 0.0f; + outsum[3] = 0.0f; + outsum[4] = 0.0f; + outsum[5] = 0.0f; + outsum[6] = 0.0f; + outsum[7] = 0.0f; + } + outsum[0] = 0.0f; + } + + for(j=0; j<n_in; j++)/* each in */ + { + in = io[j]; + thrw = mat[j]; + if(thrw) + { + thrw--; + outsum = x->x_outsumbuf + (n+1)*thrw; + for(i=n; i; i -= 8, outsum += 8, in += 8) + { + outsum[0] += in[0]; + outsum[1] += in[1]; + outsum[2] += in[2]; + outsum[3] += in[3]; + outsum[4] += in[4]; + outsum[5] += in[5]; + outsum[6] += in[6]; + outsum[7] += in[7]; + } + outsum[0] += in[0]; + } + } + + for(j=0; j<n_out; j++)/* copy out-buffer to out */ + { + out = io[n_in+j]; + outsum = x->x_outsumbuf + j*(n+1); + for (i=n; i; i -= 8, out += 8, outsum += 8) + { + out[0] = outsum[0]; + out[1] = outsum[1]; + out[2] = outsum[2]; + out[3] = outsum[3]; + out[4] = outsum[4]; + out[5] = outsum[5]; + out[6] = outsum[6]; + out[7] = outsum[7]; + } + out[0] = outsum[0]; + } + return (w+3); +} + +static void spec2_matrix_bundle_stat_tilde_dsp(t_spec2_matrix_bundle_stat_tilde *x, t_signal **sp) +{ + int i, n=x->x_n_out*sp[0]->s_n/2; + + if(!x->x_outsumbuf) + { + x->x_outsumbufsize = n; + x->x_outsumbuf = (t_float *)getbytes((x->x_outsumbufsize+x->x_n_out) * sizeof(t_float)); + } + else if(x->x_outsumbufsize != n) + { + x->x_outsumbuf = (t_float *)resizebytes(x->x_outsumbuf, (x->x_outsumbufsize+x->x_n_out)*sizeof(t_float), (n+x->x_n_out)*sizeof(t_float)); + x->x_outsumbufsize = n; + } + + n = x->x_n_in + x->x_n_out; + for(i=0; i<n; i++) + { + x->x_io[i] = sp[i]->s_vec; + /*post("iovec_addr = %d", (unsigned int)x->x_io[i]);*/ + } + + n = sp[0]->s_n/2; + if(n&7) + dsp_add(spec2_matrix_bundle_stat_tilde_perform, 2, x, n); + else + dsp_add(spec2_matrix_bundle_stat_tilde_perf8, 2, x, n); +} + + +/* setup/setdown things */ + +static void spec2_matrix_bundle_stat_tilde_free(t_spec2_matrix_bundle_stat_tilde *x) +{ + freebytes(x->x_matbuf, x->x_n_in * sizeof(int)); + freebytes(x->x_io, (x->x_n_in + x->x_n_out) * sizeof(t_float *)); + if(x->x_outsumbuf) + freebytes(x->x_outsumbuf, (x->x_outsumbufsize+1) * sizeof(t_float)); +} + +static void *spec2_matrix_bundle_stat_tilde_new(t_symbol *s, int argc, t_atom *argv) +{ + t_spec2_matrix_bundle_stat_tilde *x = (t_spec2_matrix_bundle_stat_tilde *)pd_new(spec2_matrix_bundle_stat_tilde_class); + int i; + + switch (argc) + { + case 0: + x->x_n_in = x->x_n_out = 1; + break; + case 1: + x->x_n_in = x->x_n_out = (int)atom_getint(argv); + break; + default: + x->x_n_in = (int)atom_getint(argv); + x->x_n_out = (int)atom_getint(argv+1); + break; + } + + if(x->x_n_in < 1) + x->x_n_in = 1; + if(x->x_n_out < 1) + x->x_n_out = 1; + i = x->x_n_in - 1; + while(i--) + inlet_new(&x->x_obj, &x->x_obj.ob_pd, &s_signal, &s_signal); + i = x->x_n_out; + while(i--) + outlet_new(&x->x_obj, &s_signal); + x->x_msi = 0; + x->x_outsumbuf = (t_float *)0; + x->x_outsumbufsize = 0; + x->x_matbuf = (int *)getbytes(x->x_n_in * sizeof(int)); + x->x_io = (t_float **)getbytes((x->x_n_in + x->x_n_out) * sizeof(t_float *)); + return (x); +} + +void spec2_matrix_bundle_stat_tilde_setup(void) +{ + spec2_matrix_bundle_stat_tilde_class = class_new(gensym("spec2_matrix_bundle_stat~"), (t_newmethod)spec2_matrix_bundle_stat_tilde_new, (t_method)spec2_matrix_bundle_stat_tilde_free, + sizeof(t_spec2_matrix_bundle_stat_tilde), 0, A_GIMME, 0); + CLASS_MAINSIGNALIN(spec2_matrix_bundle_stat_tilde_class, t_spec2_matrix_bundle_stat_tilde, x_msi); + class_addmethod(spec2_matrix_bundle_stat_tilde_class, (t_method)spec2_matrix_bundle_stat_tilde_dsp, gensym("dsp"), 0); + class_addlist(spec2_matrix_bundle_stat_tilde_class, (t_method)spec2_matrix_bundle_stat_tilde_list); + class_addmethod(spec2_matrix_bundle_stat_tilde_class, (t_method)spec2_matrix_bundle_stat_tilde_element, gensym("element"), A_GIMME, 0); + class_addmethod(spec2_matrix_bundle_stat_tilde_class, (t_method)spec2_matrix_bundle_stat_tilde_bundle, gensym("bundle"), A_GIMME, 0); + class_sethelpsymbol(spec2_matrix_bundle_stat_tilde_class, gensym("iemhelp2/spec2_matrix_bundle_stat~-help")); +} |