apps/plugins/pdbox/PDa/intern/bp~.c

   1 #include "../src/m_pd.h"
   2 #include <../src/m_fixed.h>
   3
   4 typedef struct bpctl
   5 {
   6     t_sample c_x1;
   7     t_sample c_x2;
   8     t_sample c_coef1;
   9     t_sample c_coef2;
  10     t_sample c_gain;
  11 } t_bpctl;
  12
  13 typedef struct sigbp
  14 {
  15     t_object x_obj;
  16     float x_sr;
  17     float x_freq;
  18     float x_q;
  19     t_bpctl x_cspace;
  20     t_bpctl *x_ctl;
  21     float x_f;
  22 } t_sigbp;
  23
  24 t_class *sigbp_class;
  25
  26 static void sigbp_docoef(t_sigbp *x, t_floatarg f, t_floatarg q);
  27
  28 static void *sigbp_new(t_floatarg f, t_floatarg q)
  29 {
  30     t_sigbp *x = (t_sigbp *)pd_new(sigbp_class);
  31     inlet_new(&x->x_obj, &x->x_obj.ob_pd, gensym("float"), gensym("ft1"));
  32     inlet_new(&x->x_obj, &x->x_obj.ob_pd, gensym("float"), gensym("ft2"));
  33     outlet_new(&x->x_obj, gensym("signal"));
  34     x->x_sr = 44100;
  35     x->x_ctl = &x->x_cspace;
  36     x->x_cspace.c_x1 = 0;
  37     x->x_cspace.c_x2 = 0;
  38     sigbp_docoef(x, f, q);
  39     x->x_f = 0;
  40     return (x);
  41 }
  42
  43 static float sigbp_qcos(float f)
  44 {
  45     if (f >= -(0.5f*3.14159f) && f <= 0.5f*3.14159f)
  46     {
  47         float g = f*f;
  48         return (((g*g*g * (-1.0f/720.0f) + g*g*(1.0f/24.0f)) - g*0.5) + 1);
  49     }
  50     else return (0);
  51 }
  52
  53 static void sigbp_docoef(t_sigbp *x, t_floatarg f, t_floatarg q)
  54 {
  55     float r, oneminusr, omega;
  56     if (f < 0.001) f = 10;
  57     if (q < 0) q = 0;
  58     x->x_freq = f;
  59     x->x_q = q;
  60     omega = f * (2.0f * 3.14159f) / x->x_sr;
  61     if (q < 0.001) oneminusr = 1.0f;
  62     else oneminusr = omega/q;
  63     if (oneminusr > 1.0f) oneminusr = 1.0f;
  64     r = 1.0f - oneminusr;
  65     x->x_ctl->c_coef1 = ftofix(2.0f * sigbp_qcos(omega) * r);
  66     x->x_ctl->c_coef2 = ftofix(- r * r);
  67     x->x_ctl->c_gain = ftofix(2 * oneminusr * (oneminusr + r * omega));
  68     /* post("r %f, omega %f, coef1 %f, coef2 %f",
  69         r, omega, x->x_ctl->c_coef1, x->x_ctl->c_coef2); */
  70 }
  71
  72 static void sigbp_ft1(t_sigbp *x, t_floatarg f)
  73 {
  74     sigbp_docoef(x, f, x->x_q);
  75 }
  76
  77 static void sigbp_ft2(t_sigbp *x, t_floatarg q)
  78 {
  79     sigbp_docoef(x, x->x_freq, q);
  80 }
  81
  82 static void sigbp_clear(t_sigbp *x, t_floatarg q)
  83 {
  84 #ifdef ROCKBOX
  85     (void) q;
  86 #endif
  87     x->x_ctl->c_x1 = x->x_ctl->c_x2 = 0;
  88 }
  89
  90 static t_int *sigbp_perform(t_int *w)
  91 {
  92     t_sample *in = (t_sample *)(w[1]);
  93     t_sample *out = (t_sample *)(w[2]);
  94     t_bpctl *c = (t_bpctl *)(w[3]);
  95     int n = (t_int)(w[4]);
  96     int i;
  97     t_sample last = c->c_x1;
  98     t_sample prev = c->c_x2;
  99     t_sample coef1 = c->c_coef1;
 100     t_sample coef2 = c->c_coef2;
 101     t_sample gain = c->c_gain;
 102     for (i = 0; i < n; i++)
 103     {
 104         t_sample output =  *in++ + mult(coef1,last) + mult(coef2,prev);
 105         *out++ = mult(gain,output);
 106         prev = last;
 107         last = output;
 108     }
 109     if (PD_BADFLOAT(last))
 110         last = 0;
 111     if (PD_BADFLOAT(prev))
 112         prev = 0;
 113     c->c_x1 = last;
 114     c->c_x2 = prev;
 115     return (w+5);
 116 }
 117
 118 static void sigbp_dsp(t_sigbp *x, t_signal **sp)
 119 {
 120     x->x_sr = sp[0]->s_sr;
 121     sigbp_docoef(x, x->x_freq, x->x_q);
 122     dsp_add(sigbp_perform, 4,
 123         sp[0]->s_vec, sp[1]->s_vec,
 124             x->x_ctl, sp[0]->s_n);
 125
 126 }
 127
 128 void bp_tilde_setup(void)
 129 {
 130     sigbp_class = class_new(gensym("bp~"), (t_newmethod)sigbp_new, 0,
 131         sizeof(t_sigbp), 0, A_DEFFLOAT, A_DEFFLOAT, 0);
 132     CLASS_MAINSIGNALIN(sigbp_class, t_sigbp, x_f);
 133     class_addmethod(sigbp_class, (t_method)sigbp_dsp, gensym("dsp"), 0);
 134     class_addmethod(sigbp_class, (t_method)sigbp_ft1,
 135         gensym("ft1"), A_FLOAT, 0);
 136     class_addmethod(sigbp_class, (t_method)sigbp_ft2,
 137         gensym("ft2"), A_FLOAT, 0);
 138     class_addmethod(sigbp_class, (t_method)sigbp_clear, gensym("clear"), 0);
 139     class_sethelpsymbol(sigbp_class, gensym("lop~-help.pd"));
 140 }
 141