static t_int *sigbp_perform(t_int *w)
{
t_sample *in = (t_sample *)(w[1]);
t_sample *out = (t_sample *)(w[2]);
t_bpctl *c = (t_bpctl *)(w[3]);
int n = (t_int)(w[4]);
int i;
t_sample last = c->c_x1;
t_sample prev = c->c_x2;
t_sample coef1 = c->c_coef1;
t_sample coef2 = c->c_coef2;
t_sample gain = c->c_gain;
for (i = 0; i < n; i++)
{
t_sample output = *in++ + mult(coef1,last) + mult(coef2,prev);
*out++ = mult(gain,output);
prev = last;
last = output;
}
if (PD_BADFLOAT(last))
last = 0;
if (PD_BADFLOAT(prev))
prev = 0;
c->c_x1 = last;
c->c_x2 = prev;
return (w+5);
}
static t_int *sigbiquad_perform(t_int *w)
{
t_sample *in = (t_sample *)(w[1]);
t_sample *out = (t_sample *)(w[2]);
t_biquadctl *c = (t_biquadctl *)(w[3]);
int n = (t_int)(w[4]);
int i;
t_sample last = c->c_x1;
t_sample prev = c->c_x2;
t_sample fb1 = c->c_fb1;
t_sample fb2 = c->c_fb2;
t_sample ff1 = c->c_ff1;
t_sample ff2 = c->c_ff2;
t_sample ff3 = c->c_ff3;
for (i = 0; i < n; i++)
{
t_sample output = *in++ + mult(fb1,last) + mult(fb2,prev);
if (PD_BADFLOAT(output))
output = 0;
*out++ = mult(ff1,output) + mult(ff2,last) + mult(ff3,prev);
prev = last;
last = output;
}
c->c_x1 = last;
c->c_x2 = prev;
return (w+5);
}
static t_int *sigdelwrite_perform(t_int *w)
{
t_sample *in = (t_sample *)(w[1]);
t_delwritectl *c = (t_delwritectl *)(w[2]);
int n = (int)(w[3]);
int phase = c->c_phase, nsamps = c->c_n;
t_sample *vp = c->c_vec, *bp = vp + phase, *ep = vp + (c->c_n + XTRASAMPS);
phase += n;
while (n--)
{
t_sample f = *in++;
if (PD_BADFLOAT(f))
f = 0;
*bp++ = f;
if (bp == ep)
{
vp[0] = ep[-4];
vp[1] = ep[-3];
vp[2] = ep[-2];
vp[3] = ep[-1];
bp = vp + XTRASAMPS;
phase -= nsamps;
}
}
c->c_phase = phase;
return (w+4);
}
static void vline_tilde_float(t_vline *x, t_float f)
{
t_time timenow = clock_gettimesince(x->x_referencetime);
t_sample inlet1 = (x->x_inlet1 < 0 ? 0 : (t_sample)x->x_inlet1);
t_sample inlet2 = (t_sample) x->x_inlet2;
t_time starttime = timenow + inlet2;
t_vseg *s1, *s2, *deletefrom = 0,
*snew = (t_vseg *)t_getbytes(sizeof(*snew));
if (PD_BADFLOAT(f))
f = 0;
/* negative delay input means stop and jump immediately to new value */
if (inlet2 < 0)
{
vline_tilde_stop(x);
x->x_value = ftofix(f);
return;
}
/* check if we supplant the first item in the list. We supplant
an item by having an earlier starttime, or an equal starttime unless
the equal one was instantaneous and the new one isn't (in which case
we'll do a jump-and-slide starting at that time.) */
if (!x->x_list || x->x_list->s_starttime > starttime ||
(x->x_list->s_starttime == starttime &&
(x->x_list->s_targettime > x->x_list->s_starttime || inlet1 <= 0)))
{
deletefrom = x->x_list;
x->x_list = snew;
}
else
{
for (s1 = x->x_list; (s2 = s1->s_next); s1 = s2)
{
if (s2->s_starttime > starttime ||
(s2->s_starttime == starttime &&
(s2->s_targettime > s2->s_starttime || inlet1 <= 0)))
{
deletefrom = s2;
s1->s_next = snew;
goto didit;
}
}
s1->s_next = snew;
deletefrom = 0;
didit: ;
}
while (deletefrom)
{
s1 = deletefrom->s_next;
t_freebytes(deletefrom, sizeof(*deletefrom));
deletefrom = s1;
}
snew->s_next = 0;
snew->s_target = f;
snew->s_starttime = starttime;
snew->s_targettime = starttime + inlet1;
x->x_inlet1 = x->x_inlet2 = 0;
}
static t_int *siglop_perform(t_int *w)
{
t_sample *in = (t_sample *)(w[1]);
t_sample *out = (t_sample *)(w[2]);
t_lopctl *c = (t_lopctl *)(w[3]);
int n = (t_int)(w[4]);
int i;
t_sample last = c->c_x;
t_sample coef = c->c_coef;
t_sample feedback = ftofix(1) - coef;
for (i = 0; i < n; i++)
last = *out++ = mult(coef, *in++) + mult(feedback,last);
if (PD_BADFLOAT(last))
last = 0;
c->c_x = last;
return (w+5);
}
static void oscparse_list(t_oscparse *x, t_symbol *s, int argc, t_atom *argv)
{
int i, j, j2, k, outc = 1, blob = 0, typeonset, dataonset, nfield;
t_atom *outv;
if (!argc)
return;
for (i = 0; i < argc; i++)
if (argv[i].a_type != A_FLOAT)
{
pd_error(x, "oscparse: takes numbers only");
return;
}
if (argv[0].a_w.w_float == '#') /* it's a bundle */
{
if (argv[1].a_w.w_float != 'b' || argc < 16)
{
pd_error(x, "oscparse: malformed bundle");
return;
}
/* we ignore the timetag since there's no correct way to
convert it to Pd logical time that I can think of. LATER
consider at least outputting timetag differentially converted
into Pd time units. */
for (i = 16; i < argc-4; )
{
int msize = READINT(argv+i);
if (msize <= 0 || msize & 3)
{
pd_error(x, "oscparse: bad bundle element size");
return;
}
oscparse_list(x, 0, msize, argv+i+4);
i += msize+4;
}
return;
}
else if (argv[0].a_w.w_float != '/')
{
pd_error(x, "oscparse: not an OSC message (no leading slash)");
return;
}
for (i = 1; i < argc && argv[i].a_w.w_float != 0; i++)
if (argv[i].a_w.w_float == '/')
outc++;
i = ROUNDUPTO4(i+1);
if (argv[i].a_w.w_float != ',' || (i+1) >= argc)
{
pd_error(x, "oscparse: malformed type string (char %d, index %d)",
(int)(argv[i].a_w.w_float), i);
return;
}
typeonset = ++i;
for (; i < argc && argv[i].a_w.w_float != 0; i++)
if (argv[i].a_w.w_float == 'b')
blob = 1;
nfield = i - typeonset;
if (blob)
outc += argc - typeonset;
else outc += nfield;
outv = (t_atom *)alloca(outc * sizeof(t_atom));
dataonset = ROUNDUPTO4(i + 1);
/* post("outc %d, typeonset %d, dataonset %d, nfield %d", outc, typeonset,
dataonset, nfield); */
for (i = j = 0; i < typeonset-1 && argv[i].a_w.w_float != 0 &&
j < outc; j++)
SETSYMBOL(outv+j, grabstring(argc, argv, &i, 1));
for (i = typeonset, k = dataonset; i < typeonset + nfield; i++)
{
union
{
float z_f;
uint32_t z_i;
} z;
float f;
int blobsize;
switch ((int)(argv[i].a_w.w_float))
{
case 'f':
if (k > argc - 4)
goto tooshort;
z.z_i = READINT(argv+k);
f = z.z_f;
if (PD_BADFLOAT(f))
f = 0;
if (j >= outc)
{
bug("oscparse 1: %d >=%d", j, outc);
return;
}
SETFLOAT(outv+j, f);
j++; k += 4;
break;
case 'i':
if (k > argc - 4)
goto tooshort;
if (j >= outc)
{
bug("oscparse 2");
return;
}
SETFLOAT(outv+j, READINT(argv+k));
j++; k += 4;
break;
case 's':
if (j >= outc)
{
bug("oscparse 3");
return;
}
SETSYMBOL(outv+j, grabstring(argc, argv, &k, 0));
j++;
break;
case 'b':
if (k > argc - 4)
goto tooshort;
blobsize = READINT(argv+k);
k += 4;
if (blobsize < 0 || blobsize > argc - k)
goto tooshort;
if (j + blobsize + 1 > outc)
{
bug("oscparse 4");
return;
}
if (k + blobsize > argc)
goto tooshort;
SETFLOAT(outv+j, blobsize);
j++;
for (j2 = 0; j2 < blobsize; j++, j2++, k++)
SETFLOAT(outv+j, argv[k].a_w.w_float);
k = ROUNDUPTO4(k);
break;
default:
pd_error(x, "oscparse: unknown tag '%c' (%d)",
(int)(argv[i].a_w.w_float), (int)(argv[i].a_w.w_float));
}
}
outlet_list(x->x_obj.ob_outlet, 0, j, outv);
return;
tooshort:
pd_error(x, "oscparse: OSC message ended prematurely");
}
