1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
|
/* Copyright (c) 2003-2005 krzYszcz and others.
* For information on usage and redistribution, and for a DISCLAIMER OF ALL
* WARRANTIES, see the file, "LICENSE.txt," in this distribution. */
/* Based on Chamberlin's prototype from "Musical Applications of
Microprocessors" (csound's svfilter). Slightly distorted,
no upsampling. */
/* CHECKED scalar case: input preserved (not coefs) after changing mode */
/* CHECKME if creation args (or defaults) restored after signal disconnection */
#include <math.h>
#include "m_pd.h"
#include "shared.h"
#include "sickle/sic.h"
#if defined(_WIN32) || defined(MACOSX)
/* cf pd/src/x_arithmetic.c */
#define sinf sin
#endif
#define SVF_HZ 0
#define SVF_LINEAR 1
#define SVF_RADIANS 2
#define SVF_DRIVE .0001
#define SVF_QSTRETCH 1.2 /* CHECKED */
#define SVF_MINR 0. /* CHECKME */
#define SVF_MAXR 1.2 /* CHECKME */
#define SVF_MINOMEGA 0. /* CHECKME */
#define SVF_MAXOMEGA (SHARED_PI * .5) /* CHECKME */
#define SVF_DEFFREQ 0.
#define SVF_DEFQ .01 /* CHECKME */
typedef struct _svf
{
t_sic x_sic;
int x_mode;
float x_srcoef;
float x_band;
float x_low;
} t_svf;
static t_class *svf_class;
static t_symbol *ps_hz;
static t_symbol *ps_linear;
static t_symbol *ps_radians;
static void svf_clear(t_svf *x)
{
x->x_band = x->x_low = 0.;
}
static void svf_hz(t_svf *x)
{
x->x_mode = SVF_HZ;
}
static void svf_linear(t_svf *x)
{
x->x_mode = SVF_LINEAR;
}
static void svf_radians(t_svf *x)
{
x->x_mode = SVF_RADIANS;
}
/* LATER make ready for optional audio-rate modulation
(separate scalar case routines, use sic_makecostable(), etc.) */
static t_int *svf_perform(t_int *w)
{
t_svf *x = (t_svf *)(w[1]);
int nblock = (int)(w[2]);
t_float *xin = (t_float *)(w[3]);
t_float fin0 = *(t_float *)(w[4]);
t_float rin0 = *(t_float *)(w[5]);
t_float *lout = (t_float *)(w[6]);
t_float *hout = (t_float *)(w[7]);
t_float *bout = (t_float *)(w[8]);
t_float *nout = (t_float *)(w[9]);
float band = x->x_band;
float low = x->x_low;
/* CHECKME sampled once per block */
float c1, c2;
float r = (1. - rin0) * SVF_QSTRETCH; /* CHECKED */
if (r < SVF_MINR)
r = SVF_MINR;
else if (r > SVF_MAXR)
r = SVF_MAXR;
c2 = r * r;
if (x->x_mode == SVF_HZ)
{
float omega = fin0 * x->x_srcoef;
if (omega < SVF_MINOMEGA)
omega = SVF_MINOMEGA;
else if (omega > SVF_MAXOMEGA)
omega = SVF_MAXOMEGA;
c1 = sinf(omega);
/* CHECKED irs slightly drift apart at high omega, LATER investigate */
}
else if (x->x_mode == SVF_LINEAR)
c1 = sinf(fin0 * (SHARED_PI * .5)); /* CHECKME actual range of fin0 */
else
c1 = fin0; /* CHECKME range */
while (nblock--)
{
float high, xn = *xin++;
*lout++ = low = low + c1 * band;
*hout++ = high = xn - low - c2 * band;
*bout++ = band = c1 * high + band;
*nout++ = low + high;
band -= band * band * band * SVF_DRIVE;
}
/* LATER rethink */
x->x_band = (PD_BIGORSMALL(band) ? 0. : band);
x->x_low = (PD_BIGORSMALL(low) ? 0. : low);
return (w + 10);
}
static void svf_dsp(t_svf *x, t_signal **sp)
{
x->x_srcoef = SHARED_2PI / sp[0]->s_sr;
svf_clear(x);
dsp_add(svf_perform, 9, x, sp[0]->s_n,
sp[0]->s_vec, sp[1]->s_vec, sp[2]->s_vec, sp[3]->s_vec,
sp[4]->s_vec, sp[5]->s_vec, sp[6]->s_vec);
}
static void *svf_new(t_symbol *s, int ac, t_atom *av)
{
t_svf *x = (t_svf *)pd_new(svf_class);
t_float freq = SVF_DEFFREQ, qcoef = SVF_DEFQ;
t_symbol *modesym = 0;
int i;
for (i = 0; i < ac; i++) if (av[i].a_type == A_SYMBOL)
{
modesym = av[i].a_w.w_symbol;
break;
}
while (ac && av->a_type != A_FLOAT) ac--, av++;
if (ac)
{
freq = av->a_w.w_float;
ac--; av++;
while (ac && av->a_type != A_FLOAT) ac--, av++;
if (ac)
qcoef = av->a_w.w_float;
}
x->x_srcoef = SHARED_PI / sys_getsr();
sic_newinlet((t_sic *)x, freq);
sic_newinlet((t_sic *)x, qcoef);
outlet_new((t_object *)x, &s_signal);
outlet_new((t_object *)x, &s_signal);
outlet_new((t_object *)x, &s_signal);
outlet_new((t_object *)x, &s_signal);
svf_clear(x);
if (modesym == ps_linear)
x->x_mode = SVF_LINEAR;
else if (modesym == ps_radians)
x->x_mode = SVF_RADIANS;
else
{
x->x_mode = SVF_HZ;
if (modesym && modesym != &s_ &&
modesym != ps_hz && modesym != gensym("Hz"))
{
/* CHECKED no warning */
}
}
return (x);
}
void svf_tilde_setup(void)
{
ps_hz = gensym("hz");
ps_linear = gensym("linear");
ps_radians = gensym("radians");
svf_class = class_new(gensym("svf~"),
(t_newmethod)svf_new, 0,
sizeof(t_svf), 0, A_GIMME, 0);
sic_setup(svf_class, svf_dsp, SIC_FLOATTOSIGNAL);
class_addmethod(svf_class, (t_method)svf_clear, gensym("clear"), 0);
class_addmethod(svf_class, (t_method)svf_hz, ps_hz, 0);
class_addmethod(svf_class, (t_method)svf_hz, gensym("Hz"), 0);
class_addmethod(svf_class, (t_method)svf_linear, ps_linear, 0);
class_addmethod(svf_class, (t_method)svf_radians, ps_radians, 0);
}
|
