|
|
|
|
@ -28,145 +28,151 @@ warren@wpratt.com
@@ -28,145 +28,151 @@ warren@wpratt.com
|
|
|
|
|
|
|
|
|
|
#include "comm.hpp" |
|
|
|
|
#include "gen.hpp" |
|
|
|
|
#include "RXA.hpp" |
|
|
|
|
#include "TXA.hpp" |
|
|
|
|
|
|
|
|
|
namespace WDSP { |
|
|
|
|
|
|
|
|
|
void GEN::calc_tone (GEN *a) |
|
|
|
|
void GEN::calc_tone() |
|
|
|
|
{ |
|
|
|
|
a->tone.phs = 0.0; |
|
|
|
|
a->tone.delta = TWOPI * a->tone.freq / a->rate; |
|
|
|
|
a->tone.cosdelta = cos (a->tone.delta); |
|
|
|
|
a->tone.sindelta = sin (a->tone.delta); |
|
|
|
|
tone.phs = 0.0; |
|
|
|
|
tone.delta = TWOPI * tone.freq / rate; |
|
|
|
|
tone.cosdelta = cos (tone.delta); |
|
|
|
|
tone.sindelta = sin (tone.delta); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::calc_tt (GEN *a) |
|
|
|
|
void GEN::calc_tt() |
|
|
|
|
{ |
|
|
|
|
a->tt.phs1 = 0.0; |
|
|
|
|
a->tt.phs2 = 0.0; |
|
|
|
|
a->tt.delta1 = TWOPI * a->tt.f1 / a->rate; |
|
|
|
|
a->tt.delta2 = TWOPI * a->tt.f2 / a->rate; |
|
|
|
|
a->tt.cosdelta1 = cos (a->tt.delta1); |
|
|
|
|
a->tt.cosdelta2 = cos (a->tt.delta2); |
|
|
|
|
a->tt.sindelta1 = sin (a->tt.delta1); |
|
|
|
|
a->tt.sindelta2 = sin (a->tt.delta2); |
|
|
|
|
tt.phs1 = 0.0; |
|
|
|
|
tt.phs2 = 0.0; |
|
|
|
|
tt.delta1 = TWOPI * tt.f1 / rate; |
|
|
|
|
tt.delta2 = TWOPI * tt.f2 / rate; |
|
|
|
|
tt.cosdelta1 = cos (tt.delta1); |
|
|
|
|
tt.cosdelta2 = cos (tt.delta2); |
|
|
|
|
tt.sindelta1 = sin (tt.delta1); |
|
|
|
|
tt.sindelta2 = sin (tt.delta2); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::calc_sweep (GEN *a) |
|
|
|
|
void GEN::calc_sweep() |
|
|
|
|
{ |
|
|
|
|
a->sweep.phs = 0.0; |
|
|
|
|
a->sweep.dphs = TWOPI * a->sweep.f1 / a->rate; |
|
|
|
|
a->sweep.d2phs = TWOPI * a->sweep.sweeprate / (a->rate * a->rate); |
|
|
|
|
a->sweep.dphsmax = TWOPI * a->sweep.f2 / a->rate; |
|
|
|
|
sweep.phs = 0.0; |
|
|
|
|
sweep.dphs = TWOPI * sweep.f1 / rate; |
|
|
|
|
sweep.d2phs = TWOPI * sweep.sweeprate / (rate * rate); |
|
|
|
|
sweep.dphsmax = TWOPI * sweep.f2 / rate; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::calc_sawtooth (GEN *a) |
|
|
|
|
void GEN::calc_sawtooth() |
|
|
|
|
{ |
|
|
|
|
a->saw.period = 1.0 / a->saw.f; |
|
|
|
|
a->saw.delta = 1.0 / a->rate; |
|
|
|
|
a->saw.t = 0.0; |
|
|
|
|
saw.period = 1.0 / saw.f; |
|
|
|
|
saw.delta = 1.0 / rate; |
|
|
|
|
saw.t = 0.0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::calc_triangle (GEN *a) |
|
|
|
|
void GEN::calc_triangle() |
|
|
|
|
{ |
|
|
|
|
a->tri.period = 1.0 / a->tri.f; |
|
|
|
|
a->tri.half = 0.5 * a->tri.period; |
|
|
|
|
a->tri.delta = 1.0 / a->rate; |
|
|
|
|
a->tri.t = 0.0; |
|
|
|
|
a->tri.t1 = 0.0; |
|
|
|
|
tri.period = 1.0 / tri.f; |
|
|
|
|
tri.half = 0.5 * tri.period; |
|
|
|
|
tri.delta = 1.0 / rate; |
|
|
|
|
tri.t = 0.0; |
|
|
|
|
tri.t1 = 0.0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::calc_pulse (GEN *a) |
|
|
|
|
void GEN::calc_pulse () |
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
float delta, theta; |
|
|
|
|
a->pulse.pperiod = 1.0 / a->pulse.pf; |
|
|
|
|
a->pulse.tphs = 0.0; |
|
|
|
|
a->pulse.tdelta = TWOPI * a->pulse.tf / a->rate; |
|
|
|
|
a->pulse.tcosdelta = cos (a->pulse.tdelta); |
|
|
|
|
a->pulse.tsindelta = sin (a->pulse.tdelta); |
|
|
|
|
a->pulse.pntrans = (int)(a->pulse.ptranstime * a->rate); |
|
|
|
|
a->pulse.pnon = (int)(a->pulse.pdutycycle * a->pulse.pperiod * a->rate); |
|
|
|
|
a->pulse.pnoff = (int)(a->pulse.pperiod * a->rate) - a->pulse.pnon - 2 * a->pulse.pntrans; |
|
|
|
|
if (a->pulse.pnoff < 0) a->pulse.pnoff = 0; |
|
|
|
|
a->pulse.pcount = a->pulse.pnoff; |
|
|
|
|
a->pulse.state = 0; |
|
|
|
|
a->pulse.ctrans = new float[a->pulse.pntrans + 1]; // (float *) malloc0 ((a->pulse.pntrans + 1) * sizeof (float));
|
|
|
|
|
delta = PI / (float)a->pulse.pntrans; |
|
|
|
|
pulse.pperiod = 1.0 / pulse.pf; |
|
|
|
|
pulse.tphs = 0.0; |
|
|
|
|
pulse.tdelta = TWOPI * pulse.tf / rate; |
|
|
|
|
pulse.tcosdelta = cos (pulse.tdelta); |
|
|
|
|
pulse.tsindelta = sin (pulse.tdelta); |
|
|
|
|
pulse.pntrans = (int)(pulse.ptranstime * rate); |
|
|
|
|
pulse.pnon = (int)(pulse.pdutycycle * pulse.pperiod * rate); |
|
|
|
|
pulse.pnoff = (int)(pulse.pperiod * rate) - pulse.pnon - 2 * pulse.pntrans; |
|
|
|
|
|
|
|
|
|
if (pulse.pnoff < 0) |
|
|
|
|
pulse.pnoff = 0; |
|
|
|
|
|
|
|
|
|
pulse.pcount = pulse.pnoff; |
|
|
|
|
pulse.state = 0; |
|
|
|
|
pulse.ctrans = new float[pulse.pntrans + 1]; // (float *) malloc0 ((pulse.pntrans + 1) * sizeof (float));
|
|
|
|
|
delta = PI / (float)pulse.pntrans; |
|
|
|
|
theta = 0.0; |
|
|
|
|
for (i = 0; i <= a->pulse.pntrans; i++) |
|
|
|
|
for (i = 0; i <= pulse.pntrans; i++) |
|
|
|
|
{ |
|
|
|
|
a->pulse.ctrans[i] = 0.5 * (1.0 - cos (theta)); |
|
|
|
|
pulse.ctrans[i] = 0.5 * (1.0 - cos (theta)); |
|
|
|
|
theta += delta; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::calc_gen (GEN *a) |
|
|
|
|
void GEN::calc() |
|
|
|
|
{ |
|
|
|
|
calc_tone (a); |
|
|
|
|
calc_tt (a); |
|
|
|
|
calc_sweep (a); |
|
|
|
|
calc_sawtooth (a); |
|
|
|
|
calc_triangle (a); |
|
|
|
|
calc_pulse (a); |
|
|
|
|
calc_tone(); |
|
|
|
|
calc_tt(); |
|
|
|
|
calc_sweep(); |
|
|
|
|
calc_sawtooth(); |
|
|
|
|
calc_triangle(); |
|
|
|
|
calc_pulse(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::decalc_gen (GEN *a) |
|
|
|
|
void GEN::decalc() |
|
|
|
|
{ |
|
|
|
|
delete[] (a->pulse.ctrans); |
|
|
|
|
delete[] (pulse.ctrans); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
GEN* GEN::create_gen (int run, int size, float* in, float* out, int rate, int mode) |
|
|
|
|
GEN::GEN( |
|
|
|
|
int _run, |
|
|
|
|
int _size, |
|
|
|
|
float* _in, |
|
|
|
|
float* _out, |
|
|
|
|
int _rate, |
|
|
|
|
int _mode |
|
|
|
|
) : |
|
|
|
|
run(_run), |
|
|
|
|
size(_size), |
|
|
|
|
in(_in), |
|
|
|
|
out(_out), |
|
|
|
|
rate((double) _rate), |
|
|
|
|
mode(_mode) |
|
|
|
|
{ |
|
|
|
|
GEN *a = new GEN; |
|
|
|
|
a->run = run; |
|
|
|
|
a->size = size; |
|
|
|
|
a->in = in; |
|
|
|
|
a->out = out; |
|
|
|
|
a->rate = (float)rate; |
|
|
|
|
a->mode = mode; |
|
|
|
|
// tone
|
|
|
|
|
a->tone.mag = 1.0; |
|
|
|
|
a->tone.freq = 1000.0; |
|
|
|
|
tone.mag = 1.0; |
|
|
|
|
tone.freq = 1000.0; |
|
|
|
|
// two-tone
|
|
|
|
|
a->tt.mag1 = 0.5; |
|
|
|
|
a->tt.mag2 = 0.5; |
|
|
|
|
a->tt.f1 = + 900.0; |
|
|
|
|
a->tt.f2 = + 1700.0; |
|
|
|
|
tt.mag1 = 0.5; |
|
|
|
|
tt.mag2 = 0.5; |
|
|
|
|
tt.f1 = + 900.0; |
|
|
|
|
tt.f2 = + 1700.0; |
|
|
|
|
// noise
|
|
|
|
|
srand ((unsigned int) time (0)); |
|
|
|
|
a->noise.mag = 1.0; |
|
|
|
|
noise.mag = 1.0; |
|
|
|
|
// sweep
|
|
|
|
|
a->sweep.mag = 1.0; |
|
|
|
|
a->sweep.f1 = -20000.0; |
|
|
|
|
a->sweep.f2 = +20000.0; |
|
|
|
|
a->sweep.sweeprate = +4000.0; |
|
|
|
|
sweep.mag = 1.0; |
|
|
|
|
sweep.f1 = -20000.0; |
|
|
|
|
sweep.f2 = +20000.0; |
|
|
|
|
sweep.sweeprate = +4000.0; |
|
|
|
|
// sawtooth
|
|
|
|
|
a->saw.mag = 1.0; |
|
|
|
|
a->saw.f = 500.0; |
|
|
|
|
saw.mag = 1.0; |
|
|
|
|
saw.f = 500.0; |
|
|
|
|
// triangle
|
|
|
|
|
a->tri.mag = 1.0; |
|
|
|
|
a->tri.f = 500.0; |
|
|
|
|
tri.mag = 1.0; |
|
|
|
|
tri.f = 500.0; |
|
|
|
|
// pulse
|
|
|
|
|
a->pulse.mag = 1.0; |
|
|
|
|
a->pulse.pf = 0.25; |
|
|
|
|
a->pulse.pdutycycle = 0.25; |
|
|
|
|
a->pulse.ptranstime = 0.002; |
|
|
|
|
a->pulse.tf = 1000.0; |
|
|
|
|
calc_gen (a); |
|
|
|
|
return a; |
|
|
|
|
pulse.mag = 1.0; |
|
|
|
|
pulse.pf = 0.25; |
|
|
|
|
pulse.pdutycycle = 0.25; |
|
|
|
|
pulse.ptranstime = 0.002; |
|
|
|
|
pulse.tf = 1000.0; |
|
|
|
|
calc(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::destroy_gen (GEN *a) |
|
|
|
|
GEN::~GEN() |
|
|
|
|
{ |
|
|
|
|
decalc_gen (a); |
|
|
|
|
delete (a); |
|
|
|
|
decalc(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::flush_gen (GEN *a) |
|
|
|
|
void GEN::flush() |
|
|
|
|
{ |
|
|
|
|
a->pulse.state = 0; |
|
|
|
|
pulse.state = 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
enum pstate |
|
|
|
|
@ -177,29 +183,29 @@ enum pstate
@@ -177,29 +183,29 @@ enum pstate
|
|
|
|
|
DOWN |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
void GEN::xgen (GEN *a) |
|
|
|
|
void GEN::execute() |
|
|
|
|
{ |
|
|
|
|
if (a->run) |
|
|
|
|
if (run) |
|
|
|
|
{ |
|
|
|
|
switch (a->mode) |
|
|
|
|
switch (mode) |
|
|
|
|
{ |
|
|
|
|
case 0: // tone
|
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
float t1, t2; |
|
|
|
|
float cosphase = cos (a->tone.phs); |
|
|
|
|
float sinphase = sin (a->tone.phs); |
|
|
|
|
for (i = 0; i < a->size; i++) |
|
|
|
|
float cosphase = cos (tone.phs); |
|
|
|
|
float sinphase = sin (tone.phs); |
|
|
|
|
for (i = 0; i < size; i++) |
|
|
|
|
{ |
|
|
|
|
a->out[2 * i + 0] = + a->tone.mag * cosphase; |
|
|
|
|
a->out[2 * i + 1] = - a->tone.mag * sinphase; |
|
|
|
|
out[2 * i + 0] = + tone.mag * cosphase; |
|
|
|
|
out[2 * i + 1] = - tone.mag * sinphase; |
|
|
|
|
t1 = cosphase; |
|
|
|
|
t2 = sinphase; |
|
|
|
|
cosphase = t1 * a->tone.cosdelta - t2 * a->tone.sindelta; |
|
|
|
|
sinphase = t1 * a->tone.sindelta + t2 * a->tone.cosdelta; |
|
|
|
|
a->tone.phs += a->tone.delta; |
|
|
|
|
if (a->tone.phs >= TWOPI) a->tone.phs -= TWOPI; |
|
|
|
|
if (a->tone.phs < 0.0 ) a->tone.phs += TWOPI; |
|
|
|
|
cosphase = t1 * tone.cosdelta - t2 * tone.sindelta; |
|
|
|
|
sinphase = t1 * tone.sindelta + t2 * tone.cosdelta; |
|
|
|
|
tone.phs += tone.delta; |
|
|
|
|
if (tone.phs >= TWOPI) tone.phs -= TWOPI; |
|
|
|
|
if (tone.phs < 0.0 ) tone.phs += TWOPI; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
@ -207,28 +213,28 @@ void GEN::xgen (GEN *a)
@@ -207,28 +213,28 @@ void GEN::xgen (GEN *a)
|
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
float tcos, tsin; |
|
|
|
|
float cosphs1 = cos (a->tt.phs1); |
|
|
|
|
float sinphs1 = sin (a->tt.phs1); |
|
|
|
|
float cosphs2 = cos (a->tt.phs2); |
|
|
|
|
float sinphs2 = sin (a->tt.phs2); |
|
|
|
|
for (i = 0; i < a->size; i++) |
|
|
|
|
float cosphs1 = cos (tt.phs1); |
|
|
|
|
float sinphs1 = sin (tt.phs1); |
|
|
|
|
float cosphs2 = cos (tt.phs2); |
|
|
|
|
float sinphs2 = sin (tt.phs2); |
|
|
|
|
for (i = 0; i < size; i++) |
|
|
|
|
{ |
|
|
|
|
a->out[2 * i + 0] = + a->tt.mag1 * cosphs1 + a->tt.mag2 * cosphs2; |
|
|
|
|
a->out[2 * i + 1] = - a->tt.mag1 * sinphs1 - a->tt.mag2 * sinphs2; |
|
|
|
|
out[2 * i + 0] = + tt.mag1 * cosphs1 + tt.mag2 * cosphs2; |
|
|
|
|
out[2 * i + 1] = - tt.mag1 * sinphs1 - tt.mag2 * sinphs2; |
|
|
|
|
tcos = cosphs1; |
|
|
|
|
tsin = sinphs1; |
|
|
|
|
cosphs1 = tcos * a->tt.cosdelta1 - tsin * a->tt.sindelta1; |
|
|
|
|
sinphs1 = tcos * a->tt.sindelta1 + tsin * a->tt.cosdelta1; |
|
|
|
|
a->tt.phs1 += a->tt.delta1; |
|
|
|
|
if (a->tt.phs1 >= TWOPI) a->tt.phs1 -= TWOPI; |
|
|
|
|
if (a->tt.phs1 < 0.0 ) a->tt.phs1 += TWOPI; |
|
|
|
|
cosphs1 = tcos * tt.cosdelta1 - tsin * tt.sindelta1; |
|
|
|
|
sinphs1 = tcos * tt.sindelta1 + tsin * tt.cosdelta1; |
|
|
|
|
tt.phs1 += tt.delta1; |
|
|
|
|
if (tt.phs1 >= TWOPI) tt.phs1 -= TWOPI; |
|
|
|
|
if (tt.phs1 < 0.0 ) tt.phs1 += TWOPI; |
|
|
|
|
tcos = cosphs2; |
|
|
|
|
tsin = sinphs2; |
|
|
|
|
cosphs2 = tcos * a->tt.cosdelta2 - tsin * a->tt.sindelta2; |
|
|
|
|
sinphs2 = tcos * a->tt.sindelta2 + tsin * a->tt.cosdelta2; |
|
|
|
|
a->tt.phs2 += a->tt.delta2; |
|
|
|
|
if (a->tt.phs2 >= TWOPI) a->tt.phs2 -= TWOPI; |
|
|
|
|
if (a->tt.phs2 < 0.0 ) a->tt.phs2 += TWOPI; |
|
|
|
|
cosphs2 = tcos * tt.cosdelta2 - tsin * tt.sindelta2; |
|
|
|
|
sinphs2 = tcos * tt.sindelta2 + tsin * tt.cosdelta2; |
|
|
|
|
tt.phs2 += tt.delta2; |
|
|
|
|
if (tt.phs2 >= TWOPI) tt.phs2 -= TWOPI; |
|
|
|
|
if (tt.phs2 < 0.0 ) tt.phs2 += TWOPI; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
@ -236,7 +242,7 @@ void GEN::xgen (GEN *a)
@@ -236,7 +242,7 @@ void GEN::xgen (GEN *a)
|
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
float r1, r2, c, rad; |
|
|
|
|
for (i = 0; i < a->size; i++) |
|
|
|
|
for (i = 0; i < size; i++) |
|
|
|
|
{ |
|
|
|
|
do |
|
|
|
|
{ |
|
|
|
|
@ -245,50 +251,50 @@ void GEN::xgen (GEN *a)
@@ -245,50 +251,50 @@ void GEN::xgen (GEN *a)
|
|
|
|
|
c = r1 * r1 + r2 * r2; |
|
|
|
|
} while (c >= 1.0); |
|
|
|
|
rad = sqrt (-2.0 * log (c) / c); |
|
|
|
|
a->out[2 * i + 0] = a->noise.mag * rad * r1; |
|
|
|
|
a->out[2 * i + 1] = a->noise.mag * rad * r2; |
|
|
|
|
out[2 * i + 0] = noise.mag * rad * r1; |
|
|
|
|
out[2 * i + 1] = noise.mag * rad * r2; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
case 3: // sweep
|
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
for (i = 0; i < a->size; i++) |
|
|
|
|
for (i = 0; i < size; i++) |
|
|
|
|
{ |
|
|
|
|
a->out[2 * i + 0] = + a->sweep.mag * cos(a->sweep.phs); |
|
|
|
|
a->out[2 * i + 1] = - a->sweep.mag * sin(a->sweep.phs); |
|
|
|
|
a->sweep.phs += a->sweep.dphs; |
|
|
|
|
a->sweep.dphs += a->sweep.d2phs; |
|
|
|
|
if (a->sweep.phs >= TWOPI) a->sweep.phs -= TWOPI; |
|
|
|
|
if (a->sweep.phs < 0.0 ) a->sweep.phs += TWOPI; |
|
|
|
|
if (a->sweep.dphs > a->sweep.dphsmax) |
|
|
|
|
a->sweep.dphs = TWOPI * a->sweep.f1 / a->rate; |
|
|
|
|
out[2 * i + 0] = + sweep.mag * cos(sweep.phs); |
|
|
|
|
out[2 * i + 1] = - sweep.mag * sin(sweep.phs); |
|
|
|
|
sweep.phs += sweep.dphs; |
|
|
|
|
sweep.dphs += sweep.d2phs; |
|
|
|
|
if (sweep.phs >= TWOPI) sweep.phs -= TWOPI; |
|
|
|
|
if (sweep.phs < 0.0 ) sweep.phs += TWOPI; |
|
|
|
|
if (sweep.dphs > sweep.dphsmax) |
|
|
|
|
sweep.dphs = TWOPI * sweep.f1 / rate; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
case 4: // sawtooth (audio only)
|
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
for (i = 0; i < a->size; i++) |
|
|
|
|
for (i = 0; i < size; i++) |
|
|
|
|
{ |
|
|
|
|
if (a->saw.t > a->saw.period) a->saw.t -= a->saw.period; |
|
|
|
|
a->out[2 * i + 0] = a->saw.mag * (a->saw.t * a->saw.f - 1.0); |
|
|
|
|
a->out[2 * i + 1] = 0.0; |
|
|
|
|
a->saw.t += a->saw.delta; |
|
|
|
|
if (saw.t > saw.period) saw.t -= saw.period; |
|
|
|
|
out[2 * i + 0] = saw.mag * (saw.t * saw.f - 1.0); |
|
|
|
|
out[2 * i + 1] = 0.0; |
|
|
|
|
saw.t += saw.delta; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
case 5: // triangle (audio only)
|
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
for (i = 0; i < a->size; i++) |
|
|
|
|
for (i = 0; i < size; i++) |
|
|
|
|
{ |
|
|
|
|
if (a->tri.t > a->tri.period) a->tri.t1 = a->tri.t -= a->tri.period; |
|
|
|
|
if (a->tri.t > a->tri.half) a->tri.t1 -= a->tri.delta; |
|
|
|
|
else a->tri.t1 += a->tri.delta; |
|
|
|
|
a->out[2 * i + 0] = a->tri.mag * (4.0 * a->tri.t1 * a->tri.f - 1.0); |
|
|
|
|
a->out[2 * i + 1] = 0.0; |
|
|
|
|
a->tri.t += a->tri.delta; |
|
|
|
|
if (tri.t > tri.period) tri.t1 = tri.t -= tri.period; |
|
|
|
|
if (tri.t > tri.half) tri.t1 -= tri.delta; |
|
|
|
|
else tri.t1 += tri.delta; |
|
|
|
|
out[2 * i + 0] = tri.mag * (4.0 * tri.t1 * tri.f - 1.0); |
|
|
|
|
out[2 * i + 1] = 0.0; |
|
|
|
|
tri.t += tri.delta; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
@ -296,140 +302,140 @@ void GEN::xgen (GEN *a)
@@ -296,140 +302,140 @@ void GEN::xgen (GEN *a)
|
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
float t1, t2; |
|
|
|
|
float cosphase = cos (a->pulse.tphs); |
|
|
|
|
float sinphase = sin (a->pulse.tphs); |
|
|
|
|
for (i = 0; i < a->size; i++) |
|
|
|
|
float cosphase = cos (pulse.tphs); |
|
|
|
|
float sinphase = sin (pulse.tphs); |
|
|
|
|
for (i = 0; i < size; i++) |
|
|
|
|
{ |
|
|
|
|
if (a->pulse.pnoff != 0) |
|
|
|
|
switch (a->pulse.state) |
|
|
|
|
if (pulse.pnoff != 0) |
|
|
|
|
switch (pulse.state) |
|
|
|
|
{ |
|
|
|
|
case OFF: |
|
|
|
|
a->out[2 * i + 0] = 0.0; |
|
|
|
|
if (--a->pulse.pcount == 0) |
|
|
|
|
out[2 * i + 0] = 0.0; |
|
|
|
|
if (--pulse.pcount == 0) |
|
|
|
|
{ |
|
|
|
|
a->pulse.state = UP; |
|
|
|
|
a->pulse.pcount = a->pulse.pntrans; |
|
|
|
|
pulse.state = UP; |
|
|
|
|
pulse.pcount = pulse.pntrans; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
case UP: |
|
|
|
|
a->out[2 * i + 0] = a->pulse.mag * cosphase * a->pulse.ctrans[a->pulse.pntrans - a->pulse.pcount]; |
|
|
|
|
if (--a->pulse.pcount == 0) |
|
|
|
|
out[2 * i + 0] = pulse.mag * cosphase * pulse.ctrans[pulse.pntrans - pulse.pcount]; |
|
|
|
|
if (--pulse.pcount == 0) |
|
|
|
|
{ |
|
|
|
|
a->pulse.state = ON; |
|
|
|
|
a->pulse.pcount = a->pulse.pnon; |
|
|
|
|
pulse.state = ON; |
|
|
|
|
pulse.pcount = pulse.pnon; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
case ON: |
|
|
|
|
a->out[2 * i + 0] = a->pulse.mag * cosphase; |
|
|
|
|
if (--a->pulse.pcount == 0) |
|
|
|
|
out[2 * i + 0] = pulse.mag * cosphase; |
|
|
|
|
if (--pulse.pcount == 0) |
|
|
|
|
{ |
|
|
|
|
a->pulse.state = DOWN; |
|
|
|
|
a->pulse.pcount = a->pulse.pntrans; |
|
|
|
|
pulse.state = DOWN; |
|
|
|
|
pulse.pcount = pulse.pntrans; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
case DOWN: |
|
|
|
|
a->out[2 * i + 0] = a->pulse.mag * cosphase * a->pulse.ctrans[a->pulse.pcount]; |
|
|
|
|
if (--a->pulse.pcount == 0) |
|
|
|
|
out[2 * i + 0] = pulse.mag * cosphase * pulse.ctrans[pulse.pcount]; |
|
|
|
|
if (--pulse.pcount == 0) |
|
|
|
|
{ |
|
|
|
|
a->pulse.state = OFF; |
|
|
|
|
a->pulse.pcount = a->pulse.pnoff; |
|
|
|
|
pulse.state = OFF; |
|
|
|
|
pulse.pcount = pulse.pnoff; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
else |
|
|
|
|
a->out[2 * i + 0] = 0.0; |
|
|
|
|
a->out[2 * i + 1] = 0.0; |
|
|
|
|
out[2 * i + 0] = 0.0; |
|
|
|
|
out[2 * i + 1] = 0.0; |
|
|
|
|
t1 = cosphase; |
|
|
|
|
t2 = sinphase; |
|
|
|
|
cosphase = t1 * a->pulse.tcosdelta - t2 * a->pulse.tsindelta; |
|
|
|
|
sinphase = t1 * a->pulse.tsindelta + t2 * a->pulse.tcosdelta; |
|
|
|
|
a->pulse.tphs += a->pulse.tdelta; |
|
|
|
|
if (a->pulse.tphs >= TWOPI) a->pulse.tphs -= TWOPI; |
|
|
|
|
if (a->pulse.tphs < 0.0 ) a->pulse.tphs += TWOPI; |
|
|
|
|
cosphase = t1 * pulse.tcosdelta - t2 * pulse.tsindelta; |
|
|
|
|
sinphase = t1 * pulse.tsindelta + t2 * pulse.tcosdelta; |
|
|
|
|
pulse.tphs += pulse.tdelta; |
|
|
|
|
if (pulse.tphs >= TWOPI) pulse.tphs -= TWOPI; |
|
|
|
|
if (pulse.tphs < 0.0 ) pulse.tphs += TWOPI; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
default: // silence
|
|
|
|
|
{ |
|
|
|
|
std::fill(a->out, a->out + a->size * 2, 0); |
|
|
|
|
std::fill(out, out + size * 2, 0); |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
else if (a->in != a->out) |
|
|
|
|
std::copy( a->in, a->in + a->size * 2, a->out); |
|
|
|
|
else if (in != out) |
|
|
|
|
std::copy( in, in + size * 2, out); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::setBuffers_gen (GEN *a, float* in, float* out) |
|
|
|
|
void GEN::setBuffers(float* _in, float* _out) |
|
|
|
|
{ |
|
|
|
|
a->in = in; |
|
|
|
|
a->out = out; |
|
|
|
|
in = _in; |
|
|
|
|
out = _out; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::setSamplerate_gen (GEN *a, int rate) |
|
|
|
|
void GEN::setSamplerate(int _rate) |
|
|
|
|
{ |
|
|
|
|
decalc_gen (a); |
|
|
|
|
a->rate = rate; |
|
|
|
|
calc_gen (a); |
|
|
|
|
decalc(); |
|
|
|
|
rate = _rate; |
|
|
|
|
calc(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::setSize_gen (GEN *a, int size) |
|
|
|
|
void GEN::setSize(int _size) |
|
|
|
|
{ |
|
|
|
|
a->size = size; |
|
|
|
|
flush_gen (a); |
|
|
|
|
size = _size; |
|
|
|
|
flush(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/********************************************************************************************************
|
|
|
|
|
* * |
|
|
|
|
* RXA Properties * |
|
|
|
|
* Public Properties * |
|
|
|
|
* * |
|
|
|
|
********************************************************************************************************/ |
|
|
|
|
|
|
|
|
|
// 'PreGen', gen0
|
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenRun (RXA& rxa, int run) |
|
|
|
|
void GEN::SetPreRun(int _run) |
|
|
|
|
{ |
|
|
|
|
rxa.gen0->run = run; |
|
|
|
|
run = _run; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenMode (RXA& rxa, int mode) |
|
|
|
|
void GEN::SetPreMode(int _mode) |
|
|
|
|
{ |
|
|
|
|
rxa.gen0->mode = mode; |
|
|
|
|
mode = _mode; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenToneMag (RXA& rxa, float mag) |
|
|
|
|
void GEN::SetPreToneMag(float mag) |
|
|
|
|
{ |
|
|
|
|
rxa.gen0->tone.mag = mag; |
|
|
|
|
tone.mag = mag; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenToneFreq (RXA& rxa, float freq) |
|
|
|
|
void GEN::SetPreToneFreq(float freq) |
|
|
|
|
{ |
|
|
|
|
rxa.gen0->tone.freq = freq; |
|
|
|
|
calc_tone (rxa.gen0); |
|
|
|
|
tone.freq = freq; |
|
|
|
|
calc_tone(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenNoiseMag (RXA& rxa, float mag) |
|
|
|
|
void GEN::SetPreNoiseMag (float mag) |
|
|
|
|
{ |
|
|
|
|
rxa.gen0->noise.mag = mag; |
|
|
|
|
noise.mag = mag; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenSweepMag (RXA& rxa, float mag) |
|
|
|
|
void GEN::SetPreSweepMag(float mag) |
|
|
|
|
{ |
|
|
|
|
rxa.gen0->sweep.mag = mag; |
|
|
|
|
sweep.mag = mag; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenSweepFreq (RXA& rxa, float freq1, float freq2) |
|
|
|
|
void GEN::SetPreSweepFreq(float freq1, float freq2) |
|
|
|
|
{ |
|
|
|
|
rxa.gen0->sweep.f1 = freq1; |
|
|
|
|
rxa.gen0->sweep.f2 = freq2; |
|
|
|
|
calc_sweep (rxa.gen0); |
|
|
|
|
sweep.f1 = freq1; |
|
|
|
|
sweep.f2 = freq2; |
|
|
|
|
calc_sweep(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenSweepRate (RXA& rxa, float rate) |
|
|
|
|
void GEN::SetPreSweepRate(float rate) |
|
|
|
|
{ |
|
|
|
|
rxa.gen0->sweep.sweeprate = rate; |
|
|
|
|
calc_sweep (rxa.gen0); |
|
|
|
|
sweep.sweeprate = rate; |
|
|
|
|
calc_sweep(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@ -459,7 +465,7 @@ void GEN::SetPreGenToneMag (TXA& txa, float mag)
@@ -459,7 +465,7 @@ void GEN::SetPreGenToneMag (TXA& txa, float mag)
|
|
|
|
|
void GEN::SetPreGenToneFreq (TXA& txa, float freq) |
|
|
|
|
{ |
|
|
|
|
txa.gen0.p->tone.freq = freq; |
|
|
|
|
calc_tone (txa.gen0.p); |
|
|
|
|
txa.gen0.p->calc_tone(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenNoiseMag (TXA& txa, float mag) |
|
|
|
|
@ -476,13 +482,13 @@ void GEN::SetPreGenSweepFreq (TXA& txa, float freq1, float freq2)
@@ -476,13 +482,13 @@ void GEN::SetPreGenSweepFreq (TXA& txa, float freq1, float freq2)
|
|
|
|
|
{ |
|
|
|
|
txa.gen0.p->sweep.f1 = freq1; |
|
|
|
|
txa.gen0.p->sweep.f2 = freq2; |
|
|
|
|
calc_sweep (txa.gen0.p); |
|
|
|
|
txa.gen0.p->calc_sweep(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenSweepRate (TXA& txa, float rate) |
|
|
|
|
{ |
|
|
|
|
txa.gen0.p->sweep.sweeprate = rate; |
|
|
|
|
calc_sweep (txa.gen0.p); |
|
|
|
|
txa.gen0.p->calc_sweep(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenSawtoothMag (TXA& txa, float mag) |
|
|
|
|
@ -493,7 +499,7 @@ void GEN::SetPreGenSawtoothMag (TXA& txa, float mag)
@@ -493,7 +499,7 @@ void GEN::SetPreGenSawtoothMag (TXA& txa, float mag)
|
|
|
|
|
void GEN::SetPreGenSawtoothFreq (TXA& txa, float freq) |
|
|
|
|
{ |
|
|
|
|
txa.gen0.p->saw.f = freq; |
|
|
|
|
calc_sawtooth (txa.gen0.p); |
|
|
|
|
txa.gen0.p->calc_sawtooth(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenTriangleMag (TXA& txa, float mag) |
|
|
|
|
@ -504,7 +510,7 @@ void GEN::SetPreGenTriangleMag (TXA& txa, float mag)
@@ -504,7 +510,7 @@ void GEN::SetPreGenTriangleMag (TXA& txa, float mag)
|
|
|
|
|
void GEN::SetPreGenTriangleFreq (TXA& txa, float freq) |
|
|
|
|
{ |
|
|
|
|
txa.gen0.p->tri.f = freq; |
|
|
|
|
calc_triangle (txa.gen0.p); |
|
|
|
|
txa.gen0.p->calc_triangle(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenPulseMag (TXA& txa, float mag) |
|
|
|
|
@ -515,25 +521,25 @@ void GEN::SetPreGenPulseMag (TXA& txa, float mag)
@@ -515,25 +521,25 @@ void GEN::SetPreGenPulseMag (TXA& txa, float mag)
|
|
|
|
|
void GEN::SetPreGenPulseFreq (TXA& txa, float freq) |
|
|
|
|
{ |
|
|
|
|
txa.gen0.p->pulse.pf = freq; |
|
|
|
|
calc_pulse (txa.gen0.p); |
|
|
|
|
txa.gen0.p->calc_pulse(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenPulseDutyCycle (TXA& txa, float dc) |
|
|
|
|
{ |
|
|
|
|
txa.gen0.p->pulse.pdutycycle = dc; |
|
|
|
|
calc_pulse (txa.gen0.p); |
|
|
|
|
txa.gen0.p->calc_pulse(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenPulseToneFreq (TXA& txa, float freq) |
|
|
|
|
{ |
|
|
|
|
txa.gen0.p->pulse.tf = freq; |
|
|
|
|
calc_pulse (txa.gen0.p); |
|
|
|
|
txa.gen0.p->calc_pulse(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPreGenPulseTransition (TXA& txa, float transtime) |
|
|
|
|
{ |
|
|
|
|
txa.gen0.p->pulse.ptranstime = transtime; |
|
|
|
|
calc_pulse (txa.gen0.p); |
|
|
|
|
txa.gen0.p->calc_pulse(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// 'PostGen', gen1
|
|
|
|
|
@ -556,7 +562,7 @@ void GEN::SetPostGenToneMag (TXA& txa, float mag)
@@ -556,7 +562,7 @@ void GEN::SetPostGenToneMag (TXA& txa, float mag)
|
|
|
|
|
void GEN::SetPostGenToneFreq (TXA& txa, float freq) |
|
|
|
|
{ |
|
|
|
|
txa.gen1.p->tone.freq = freq; |
|
|
|
|
calc_tone (txa.gen1.p); |
|
|
|
|
txa.gen1.p->calc_tone(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPostGenTTMag (TXA& txa, float mag1, float mag2) |
|
|
|
|
@ -569,7 +575,7 @@ void GEN::SetPostGenTTFreq (TXA& txa, float freq1, float freq2)
@@ -569,7 +575,7 @@ void GEN::SetPostGenTTFreq (TXA& txa, float freq1, float freq2)
|
|
|
|
|
{ |
|
|
|
|
txa.gen1.p->tt.f1 = freq1; |
|
|
|
|
txa.gen1.p->tt.f2 = freq2; |
|
|
|
|
calc_tt (txa.gen1.p); |
|
|
|
|
txa.gen1.p->calc_tt(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPostGenSweepMag (TXA& txa, float mag) |
|
|
|
|
@ -581,13 +587,13 @@ void GEN::SetPostGenSweepFreq (TXA& txa, float freq1, float freq2)
@@ -581,13 +587,13 @@ void GEN::SetPostGenSweepFreq (TXA& txa, float freq1, float freq2)
|
|
|
|
|
{ |
|
|
|
|
txa.gen1.p->sweep.f1 = freq1; |
|
|
|
|
txa.gen1.p->sweep.f2 = freq2; |
|
|
|
|
calc_sweep (txa.gen1.p); |
|
|
|
|
txa.gen1.p->calc_sweep(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void GEN::SetPostGenSweepRate (TXA& txa, float rate) |
|
|
|
|
{ |
|
|
|
|
txa.gen1.p->sweep.sweeprate = rate; |
|
|
|
|
calc_sweep (txa.gen1.p); |
|
|
|
|
txa.gen1.p->calc_sweep(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
} // namespace WDSP
|
|
|
|
|
|