/*
Copyright (C) 2003 Fons Adriaensen
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., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
#include <stdio.h>
#include <string.h>
#include <math.h>
#include "blvco.h"
#include "exp2ap.h"
extern float exp2ap (float x);
static float _pulse [] =
{
0.000000, 0.000366, 0.001458, 0.003117, 0.005028, 0.006756, 0.007806, 0.007704,
0.006086, 0.002778, -0.002139, -0.008292, -0.015022, -0.021434, -0.026492, -0.029153,
-0.028511, -0.023957, -0.015297, -0.002869, 0.012417, 0.029105, 0.045302, 0.058853,
0.067578, 0.069533, 0.063273, 0.048113, 0.024337, -0.006682, -0.042487, -0.079654,
-0.114036, -0.141088, -0.156243, -0.155364, -0.135210, -0.093843, -0.030932, 0.052092,
0.152049, 0.264172, 0.382359, 0.499585, 0.608450, 0.701808, 0.773391, 0.818353,
0.833670, 0.818353, 0.773391, 0.701808, 0.608450, 0.499585, 0.382359, 0.264172,
0.152049, 0.052092, -0.030932, -0.093843, -0.135210, -0.155364, -0.156243, -0.141088,
-0.114036, -0.079654, -0.042487, -0.006682, 0.024337, 0.048113, 0.063273, 0.069533,
0.067578, 0.058853, 0.045302, 0.029105, 0.012417, -0.002869, -0.015297, -0.023957,
-0.028511, -0.029153, -0.026492, -0.021434, -0.015022, -0.008292, -0.002139, 0.002778,
0.006086, 0.007704, 0.007806, 0.006756, 0.005028, 0.003117, 0.001458, 0.000366,
0.000000
};
void Ladspa_VCO_pulse1::setport (PortIndex port, PortData *data)
{
_port [port] = (float*)data;
}
void Ladspa_VCO_pulse1::active (bool act)
{
_p = 0.5;
_w = _y = _z = 0;
_j = 0;
memset (_f, 0, (FILLEN + NCOEFF) * sizeof (float));
}
void Ladspa_VCO_pulse1::runproc (SampleCount len, bool add)
{
int i, j, n;
float *outp, *freq, *expm, *linm;
float a, p, r, t, w, dw, y, z, *f;
outp = _port[OUTP];
freq = _port[FREQ] - 1;
expm = _port[EXPM] - 1;
linm = _port[LINM] - 1;
p = _p;
w = _w;
y = _y;
z = _z;
j = _j;
a = 0.2 + 0.8 * _port [FILT][0];
do
{
n = (len > 24) ? 16 : len;
freq += n;
expm += n;
linm += n;
len -= n;
t = (exp2ap (*freq + _port[OCTN][0] + _port[TUNE][0] + *expm * _port[EXPG][0] + 8.03136)
+ 1e3 * *linm * _port[LING][0]) / _fsam;
if (t < 1e-5) t = 1e-5;
if (t > 0.5) t = 0.5;
dw = (t - w) / n;
while (n--)
{
w += dw;
p += w;
if (p >= 1.0)
{
p -= 1.0;
r = NPHASE * p / w;
i = (int) r;
r -= i;
f = _f + j;
while (i < NPHASE * NCOEFF)
{
*f++ += r * _pulse [i + 1 ] + (1 - r) * _pulse [i];
i += NPHASE;
}
}
y = _f [j];
z += a * (y - z);
*outp++ = z;
if (++j == FILLEN)
{
j = 0;
memcpy (_f, _f + FILLEN, NCOEFF * sizeof (float));
memset (_f + NCOEFF, 0, FILLEN * sizeof (float));
}
}
}
while (len);
_p = p;
_w = w;
_y = y;
_z = z;
_j = j;
}
void Ladspa_VCO_saw1::setport (PortIndex port, PortData *data)
{
_port [port] = (float*)data;
}
void Ladspa_VCO_saw1::active (bool act)
{
_p = 0.5;
_w = _x = _y = _z = _d = 0;
_j = 0;
memset (_f, 0, (FILLEN + NCOEFF) * sizeof (float));
}
void Ladspa_VCO_saw1::runproc (SampleCount len, bool add)
{
int i, j, n;
float *outp, *freq, *expm, *linm, *sync;
float a, d, p, r, t, w, dw, x, y, z, *f;
outp = _port[OUTP];
freq = _port[FREQ] - 1;
expm = _port[EXPM] - 1;
linm = _port[LINM] - 1;
sync = _port[SYNC];
p = _p;
w = _w;
x = _x;
y = _y;
z = _z;
d = _d;
j = _j;
a = 0.2 + 0.8 * _port [FILT][0];
do
{
n = (len > 24) ? 16 : len;
freq += n;
expm += n;
linm += n;
len -= n;
t = (exp2ap (*freq + _port[OCTN][0] + _port[TUNE][0] + *expm * _port[EXPG][0] + 8.03136 + d)
+ 1e3 * *linm * _port[LING][0]) / _fsam;
if (t < 1e-5) t = 1e-5;
if (t > 0.5) t = 0.5;
dw = (t - w) / n;
while (n--)
{
w += dw;
p += w;
if (p >= 1.0)
{
p -= 1.0;
r = NPHASE * p / w;
i = (int) r;
r -= i;
f = _f + j;
while (i < NPHASE * NCOEFF)
{
*f++ += r * _pulse [i + 1 ] + (1 - r) * _pulse [i];
i += NPHASE;
}
}
x += _f [j] - w * (0.01 * y + 0.2 * x + 1);
y += 6.3 * w * x;
z += a * (x - z);
*outp++ = z;
d += 0.01 * (y * *sync++ - d);
if (++j == FILLEN)
{
j = 0;
memcpy (_f, _f + FILLEN, NCOEFF * sizeof (float));
memset (_f + NCOEFF, 0, FILLEN * sizeof (float));
}
}
}
while (len);
_p = p;
_w = w;
_x = x;
_y = y;
_z = z;
_d = d;
_j = j;
}
void Ladspa_VCO_rec1::setport (PortIndex port, PortData *data)
{
_port [port] = (float*)data;
}
void Ladspa_VCO_rec1::active (bool act)
{
_p = 0.0;
_x = _y = _z = _d = 0;
_w = 0;
_b = 0.5;
_j = _k = 0;
memset (_f, 0, (FILLEN + NCOEFF) * sizeof (float));
}
void Ladspa_VCO_rec1::runproc (SampleCount len, bool add)
{
int i, j, k, n;
float *outp, *freq, *expm, *linm, *wavm, *sync;
float a, b, db, d, p, r, t, w, dw, x, y, z, *f;
outp = _port[OUTP];
freq = _port[FREQ] - 1;
expm = _port[EXPM] - 1;
linm = _port[LINM] - 1;
wavm = _port[WAVM] - 1;
sync = _port[SYNC];
p = _p;
w = _w;
b = _b;
x = _x;
y = _y;
z = _z;
d = _d;
j = _j;
k = _k;
a = 0.2 + 0.8 * _port [FILT][0];
do
{
n = (len > 24) ? 16 : len;
freq += n;
expm += n;
linm += n;
wavm += n;
len -= n;
t = (exp2ap (*freq + _port[OCTN][0] + _port[TUNE][0] + *expm * _port[EXPG][0] + 8.03136 + d)
+ 1e3 * *linm * _port[LING][0]) / _fsam;
if (t < 1e-5) t = 1e-5;
if (t > 0.5) t = 0.5;
dw = (t - w) / n;
t = 0.5 * (1.0 + _port [WAVE][0] + *wavm * _port [WMOD][0]);
if (t < 0.02) t = 0.02;
if (t > 0.98) t = 0.98;
db = (t - b) / n;
while (n--)
{
w += dw;
b += db;
p += w;
t = k ? 1.0 : b;
while (p >= t)
{
if (k)
{
k = 0;
p -= 1.0;
r = NPHASE * p / w;
t = b;
i = (int) r;
r -= i;
f = _f + j;
while (i < NPHASE * NCOEFF)
{
*f++ += r * _pulse [i + 1 ] + (1 - r) * _pulse [i];
i += NPHASE;
}
}
else
{
k = 1;
r = NPHASE * (p - t) / w;
t = 1.0;
i = (int) r;
r -= i;
f = _f + j;
while (i < NPHASE * NCOEFF)
{
*f++ -= r * _pulse [i + 1 ] + (1 - r) * _pulse [i];
i += NPHASE;
}
}
}
x -= w * (0.01 * y + 0.2 * x);
x += _f [j];
y += 6.3 * w * x;
z += a * (x - z);
*outp++ = z;
d += 0.01 * (y * *sync++ - d);
if (++j == FILLEN)
{
j = 0;
memcpy (_f, _f + FILLEN, NCOEFF * sizeof (float));
memset (_f + NCOEFF, 0, FILLEN * sizeof (float));
}
}
}
while (len);
_p = p;
_w = w;
_b = b;
_x = x;
_y = y;
_z = z;
_d = d;
_j = j;
_k = k;
}