aboutsummaryrefslogtreecommitdiffstats
path: root/src/mdaTalkBox.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'src/mdaTalkBox.cpp')
-rw-r--r--src/mdaTalkBox.cpp410
1 files changed, 410 insertions, 0 deletions
diff --git a/src/mdaTalkBox.cpp b/src/mdaTalkBox.cpp
new file mode 100644
index 0000000..4464c58
--- /dev/null
+++ b/src/mdaTalkBox.cpp
@@ -0,0 +1,410 @@
+/*
+ Copyright 2008-2011 David Robillard <http://drobilla.net>
+ Copyright 1999-2000 Paul Kellett (Maxim Digital Audio)
+
+ This 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 3 of the License,
+ or (at your option) any later version.
+
+ This software 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 software. If not, see <http://www.gnu.org/licenses/>.
+*/
+
+#include "mdaTalkBox.h"
+
+#include <assert.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <float.h>
+#include <math.h>
+
+
+AudioEffect *createEffectInstance(audioMasterCallback audioMaster)
+{
+ return new mdaTalkBox(audioMaster);
+}
+
+mdaTalkBoxProgram::mdaTalkBoxProgram() ///default program settings
+{
+ param[0] = 0.5f; //wet
+ param[1] = 0.0f; //dry
+ param[2] = 0.0f; //swap
+ param[3] = 1.0f; //quality
+ strcpy(name, "Talkbox");
+}
+
+
+mdaTalkBox::mdaTalkBox(audioMasterCallback audioMaster): AudioEffectX(audioMaster, NPROGS, NPARAMS)
+{
+ setNumInputs(2);
+ setNumOutputs(2);
+ setUniqueID("mdaTalkBox"); ///identify plug-in here
+ //canMono();
+ canProcessReplacing();
+
+ ///initialise...
+ buf0 = new float[BUF_MAX];
+ buf1 = new float[BUF_MAX];
+ window = new float[BUF_MAX];
+ car0 = new float[BUF_MAX];
+ car1 = new float[BUF_MAX];
+ N = 1; //trigger window recalc
+ K = 0;
+
+ programs = new mdaTalkBoxProgram[NPROGS];
+ if(programs)
+ {
+ ///differences from default program...
+ //programs[1].param[0] = 0.1f;
+ //strcpy(programs[1].name,"Another Program");
+
+ setProgram(0);
+ }
+
+ suspend();
+}
+
+bool mdaTalkBox::getProductString(char* text) { strcpy(text, "MDA TalkBox"); return true; }
+bool mdaTalkBox::getVendorString(char* text) { strcpy(text, "mda"); return true; }
+bool mdaTalkBox::getEffectName(char* name) { strcpy(name, "TalkBox"); return true; }
+
+void mdaTalkBox::resume() ///update internal parameters...
+{
+ float fs = getSampleRate();
+ float * param = programs[curProgram].param;
+ if(fs < 8000.0f) fs = 8000.0f;
+ if(fs > 96000.0f) fs = 96000.0f;
+
+ swap = (param[2] > 0.5f)? 1 : 0;
+
+ int32_t n = (int32_t)(0.01633f * fs);
+ if(n > BUF_MAX) n = BUF_MAX;
+
+ //O = (int32_t)(0.0005f * fs);
+ O = (int32_t)((0.0001f + 0.0004f * param[3]) * fs);
+
+ if(n != N) //recalc hanning window
+ {
+ N = n;
+ float dp = TWO_PI / (float)N;
+ float p = 0.0f;
+ for(n=0; n<N; n++)
+ {
+ window[n] = 0.5f - 0.5f * (float)cos(p);
+ p += dp;
+ }
+ }
+ wet = 0.5f * param[0] * param[0];
+ dry = 2.0f * param[1] * param[1];
+}
+
+
+void mdaTalkBox::suspend() ///clear any buffers...
+{
+ pos = K = 0;
+ emphasis = 0.0f;
+ FX = 0;
+
+ u0 = u1 = u2 = u3 = u4 = 0.0f;
+ d0 = d1 = d2 = d3 = d4 = 0.0f;
+
+ memset(buf0, 0, BUF_MAX * sizeof(float));
+ memset(buf1, 0, BUF_MAX * sizeof(float));
+ memset(car0, 0, BUF_MAX * sizeof(float));
+ memset(car1, 0, BUF_MAX * sizeof(float));
+}
+
+
+mdaTalkBox::~mdaTalkBox() ///destroy any buffers...
+{
+ if(buf0) delete [] buf0;
+ if(buf1) delete [] buf1;
+ if(window) delete [] window;
+ if(car0) delete [] car0;
+ if(car1) delete [] car1;
+ if(programs) delete[] programs;
+}
+
+
+void mdaTalkBox::setProgram(int32_t program)
+{
+ curProgram = program;
+ resume();
+}
+
+
+void mdaTalkBox::setParameter(int32_t index, float value)
+{
+ programs[curProgram].param[index] = value; //bug was here!
+ resume();
+}
+
+float mdaTalkBox::getParameter(int32_t index) { return programs[curProgram].param[index]; }
+void mdaTalkBox::setProgramName(char *name) { strcpy(programs[curProgram].name, name); }
+void mdaTalkBox::getProgramName(char *name) { strcpy(name, programs[curProgram].name); }
+bool mdaTalkBox::getProgramNameIndexed (int32_t category, int32_t index, char* name)
+{
+ if ((unsigned int)index < NPROGS)
+ {
+ strcpy(name, programs[index].name);
+ return true;
+ }
+ return false;
+}
+
+void mdaTalkBox::getParameterName(int32_t index, char *label)
+{
+ switch(index)
+ {
+ case 0: strcpy(label, "Wet"); break;
+ case 1: strcpy(label, "Dry"); break;
+ case 2: strcpy(label, "Carrier"); break;
+ case 3: strcpy(label, "Quality"); break;
+ default: strcpy(label, "");
+ }
+}
+
+
+void mdaTalkBox::getParameterDisplay(int32_t index, char *text)
+{
+ char string[16];
+ float * param = programs[curProgram].param;
+
+ switch(index)
+ {
+ case 2: if(swap) strcpy(string, "LEFT"); else strcpy(string, "RIGHT"); break;
+
+ case 3: sprintf(string, "%4.0f", 5.0f + 95.0f * param[index] * param[index]); break;
+
+ default: sprintf(string, "%4.0f %%", 200.0f * param[index]);
+ }
+ string[8] = 0;
+ strcpy(text, (char *)string);
+}
+
+
+void mdaTalkBox::getParameterLabel(int32_t index, char *label)
+{
+ switch(index)
+ {
+ case 0:
+ case 1: strcpy(label, ""); break;
+
+ default: strcpy(label, "");
+ }
+}
+
+
+void mdaTalkBox::process(float **inputs, float **outputs, int32_t sampleFrames)
+{
+ float *in1 = inputs[0];
+ float *in2 = inputs[1];
+ if(swap)
+ {
+ in1 = inputs[1];
+ in2 = inputs[0];
+ }
+ float *out1 = outputs[0];
+ float *out2 = outputs[1];
+ int32_t p0=pos, p1 = (pos + N/2) % N;
+ float e=emphasis, w, o, x, c, d, dr, fx=FX;
+ float p, q, h0=0.3f, h1=0.77f;
+
+ --in1;
+ --in2;
+ --out1;
+ --out2;
+ while(--sampleFrames >= 0)
+ {
+ o = *++in1;
+ x = *++in2;
+ c = out1[1];
+ d = out2[1];
+
+ dr = o;
+
+ p = d0 + h0 * x; d0 = d1; d1 = x - h0 * p;
+ q = d2 + h1 * d4; d2 = d3; d3 = d4 - h1 * q;
+ d4 = x;
+ x = p + q;
+
+ if(K++)
+ {
+ K = 0;
+
+ car0[p0] = car1[p1] = x; //carrier input
+
+ x = o - e; e = o; //6dB/oct pre-emphasis
+
+ w = window[p0]; fx = buf0[p0] * w; buf0[p0] = x * w; //50% overlapping hanning windows
+ if(++p0 >= N) { lpc(buf0, car0, N, O); p0 = 0; }
+
+ w = 1.0f - w; fx += buf1[p1] * w; buf1[p1] = x * w;
+ if(++p1 >= N) { lpc(buf1, car1, N, O); p1 = 0; }
+ }
+
+ p = u0 + h0 * fx; u0 = u1; u1 = fx - h0 * p;
+ q = u2 + h1 * u4; u2 = u3; u3 = u4 - h1 * q;
+ u4 = fx;
+ x = p + q;
+
+ o = wet * x + dry * dr;
+ *++out1 = c + o;
+ *++out2 = d + o;
+ }
+ emphasis = e;
+ pos = p0;
+ FX = fx;
+
+ float den = 1.0e-10f; //(float)pow(10.0f, -10.0f * param[4]);
+ if(fabs(d0) < den) d0 = 0.0f; //anti-denormal (doesn't seem necessary but P4?)
+ if(fabs(d1) < den) d1 = 0.0f;
+ if(fabs(d2) < den) d2 = 0.0f;
+ if(fabs(d3) < den) d3 = 0.0f;
+ if(fabs(u0) < den) u0 = 0.0f;
+ if(fabs(u1) < den) u1 = 0.0f;
+ if(fabs(u2) < den) u2 = 0.0f;
+ if(fabs(u3) < den) u3 = 0.0f;
+}
+
+
+void mdaTalkBox::processReplacing(float **inputs, float **outputs, int32_t sampleFrames)
+{
+ float *in1 = inputs[0];
+ float *in2 = inputs[1];
+ if(swap)
+ {
+ in1 = inputs[1];
+ in2 = inputs[0];
+ }
+ float *out1 = outputs[0];
+ float *out2 = outputs[1];
+ int32_t p0=pos, p1 = (pos + N/2) % N;
+ float e=emphasis, w, o, x, dr, fx=FX;
+ float p, q, h0=0.3f, h1=0.77f;
+
+ --in1;
+ --in2;
+ --out1;
+ --out2;
+ while(--sampleFrames >= 0)
+ {
+ o = *++in1;
+ x = *++in2;
+ dr = o;
+
+ p = d0 + h0 * x; d0 = d1; d1 = x - h0 * p;
+ q = d2 + h1 * d4; d2 = d3; d3 = d4 - h1 * q;
+ d4 = x;
+ x = p + q;
+
+ if(K++)
+ {
+ K = 0;
+
+ car0[p0] = car1[p1] = x; //carrier input
+
+ x = o - e; e = o; //6dB/oct pre-emphasis
+
+ w = window[p0]; fx = buf0[p0] * w; buf0[p0] = x * w; //50% overlapping hanning windows
+ if(++p0 >= N) { lpc(buf0, car0, N, O); p0 = 0; }
+
+ w = 1.0f - w; fx += buf1[p1] * w; buf1[p1] = x * w;
+ if(++p1 >= N) { lpc(buf1, car1, N, O); p1 = 0; }
+ }
+
+ p = u0 + h0 * fx; u0 = u1; u1 = fx - h0 * p;
+ q = u2 + h1 * u4; u2 = u3; u3 = u4 - h1 * q;
+ u4 = fx;
+ x = p + q;
+
+ o = wet * x + dry * dr;
+ *++out1 = o;
+ *++out2 = o;
+ }
+ emphasis = e;
+ pos = p0;
+ FX = fx;
+
+ float den = 1.0e-10f; //(float)pow(10.0f, -10.0f * param[4]);
+ if(fabs(d0) < den) d0 = 0.0f; //anti-denormal (doesn't seem necessary but P4?)
+ if(fabs(d1) < den) d1 = 0.0f;
+ if(fabs(d2) < den) d2 = 0.0f;
+ if(fabs(d3) < den) d3 = 0.0f;
+ if(fabs(u0) < den) u0 = 0.0f;
+ if(fabs(u1) < den) u1 = 0.0f;
+ if(fabs(u2) < den) u2 = 0.0f;
+ if(fabs(u3) < den) u3 = 0.0f;
+}
+
+
+void mdaTalkBox::lpc(float *buf, float *car, int32_t n, int32_t o)
+{
+ assert(o >= 0);
+ float z[ORD_MAX], r[ORD_MAX], k[ORD_MAX], G, x;
+ int32_t i, j, nn=n;
+
+ for(j=0; j<=o; j++, nn--) //buf[] is already emphasized and windowed
+ {
+ z[j] = r[j] = 0.0f;
+ for(i=0; i<nn; i++) r[j] += buf[i] * buf[i+j]; //autocorrelation
+ }
+ r[0] *= 1.001f; //stability fix
+
+ float min = 0.00001f;
+ if(r[0] < min) { for(i=0; i<n; i++) buf[i] = 0.0f; return; }
+
+ lpc_durbin(r, o, k, &G); //calc reflection coeffs
+
+ for(i=0; i<=o; i++)
+ {
+ if(k[i] > 0.995f) k[i] = 0.995f; else if(k[i] < -0.995f) k[i] = -.995f;
+ }
+
+ for(i=0; i<n; i++)
+ {
+ x = G * car[i];
+ for(j=o; j>0; j--) //lattice filter
+ {
+ x -= k[j] * z[j-1];
+ z[j] = z[j-1] + k[j] * x;
+ }
+ buf[i] = z[0] = x; //output buf[] will be windowed elsewhere
+ }
+}
+
+
+void mdaTalkBox::lpc_durbin(float *r, int p, float *k, float *g)
+{
+ int i, j;
+ float a[ORD_MAX], at[ORD_MAX], e=r[0];
+
+ for(i=0; i<=p; i++) a[i] = at[i] = 0.0f; //probably don't need to clear at[] or k[]
+
+ for(i=1; i<=p; i++)
+ {
+ k[i] = -r[i];
+
+ for(j=1; j<i; j++)
+ {
+ at[j] = a[j];
+ k[i] -= a[j] * r[i-j];
+ }
+ if(fabs(e) < 1.0e-20f) { e = 0.0f; break; }
+ k[i] /= e;
+
+ a[i] = k[i];
+ for(j=1; j<i; j++) a[j] = at[j] + k[i] * at[i-j];
+
+ e *= 1.0f - k[i] * k[i];
+ }
+
+ if(e < 1.0e-20f) e = 0.0f;
+ *g = (float)sqrt(e);
+}