diff options
Diffstat (limited to 'src/mdaTalkBox.cpp')
-rw-r--r-- | src/mdaTalkBox.cpp | 410 |
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); +} |