airwindows/plugins/WinVST/Reverb/ReverbProc.cpp
2022-11-21 09:20:21 -05:00

764 lines
33 KiB
C++
Executable file

/* ========================================
* Reverb - Reverb.h
* Copyright (c) 2016 airwindows, Airwindows uses the MIT license
* ======================================== */
#ifndef __Reverb_H
#include "Reverb.h"
#endif
void Reverb::processReplacing(float **inputs, float **outputs, VstInt32 sampleFrames)
{
float* in1 = inputs[0];
float* in2 = inputs[1];
float* out1 = outputs[0];
float* out2 = outputs[1];
double big = A;
double wet = B;
double vibSpeed = 0.1;
double vibDepth = 7.0;
double size = (pow(big,2)*75.0)+25.0;
double depthFactor = 1.0-pow((1.0-(0.82-(((1.0-big)*0.7)+(size*0.002)))),4);
double blend = 0.955-(size*0.007);
double regen = depthFactor * 0.5;
delayA = 79*size;
delayB = 73*size;
delayC = 71*size;
delayD = 67*size;
delayE = 61*size;
delayF = 59*size;
delayG = 53*size;
delayH = 47*size;
delayI = 43*size;
delayJ = 41*size;
delayK = 37*size;
delayL = 31*size;
delayM = 29*size;
biquadC[0] = biquadB[0] = biquadA[0] = (10000.0-(big*wet*3000.0))/getSampleRate();
biquadA[1] = 1.618033988749894848204586;
biquadB[1] = 0.618033988749894848204586;
biquadC[1] = 0.5;
double K = tan(M_PI * biquadA[0]); //lowpass
double norm = 1.0 / (1.0 + K / biquadA[1] + K * K);
biquadA[2] = K * K * norm;
biquadA[3] = 2.0 * biquadA[2];
biquadA[4] = biquadA[2];
biquadA[5] = 2.0 * (K * K - 1.0) * norm;
biquadA[6] = (1.0 - K / biquadA[1] + K * K) * norm;
K = tan(M_PI * biquadA[0]);
norm = 1.0 / (1.0 + K / biquadB[1] + K * K);
biquadB[2] = K * K * norm;
biquadB[3] = 2.0 * biquadB[2];
biquadB[4] = biquadB[2];
biquadB[5] = 2.0 * (K * K - 1.0) * norm;
biquadB[6] = (1.0 - K / biquadB[1] + K * K) * norm;
K = tan(M_PI * biquadC[0]);
norm = 1.0 / (1.0 + K / biquadC[1] + K * K);
biquadC[2] = K * K * norm;
biquadC[3] = 2.0 * biquadC[2];
biquadC[4] = biquadC[2];
biquadC[5] = 2.0 * (K * K - 1.0) * norm;
biquadC[6] = (1.0 - K / biquadC[1] + K * K) * norm;
while (--sampleFrames >= 0)
{
double inputSampleL = *in1;
double inputSampleR = *in2;
if (fabs(inputSampleL)<1.18e-23) inputSampleL = fpdL * 1.18e-17;
if (fabs(inputSampleR)<1.18e-23) inputSampleR = fpdR * 1.18e-17;
double drySampleL = inputSampleL;
double drySampleR = inputSampleR;
aML[countM] = inputSampleL;
aMR[countM] = inputSampleR;
countM++; if (countM < 0 || countM > delayM) {countM = 0;}
inputSampleL = aML[countM];
inputSampleR = aMR[countM];
//predelay
double tempSampleL = (inputSampleL * biquadA[2]) + biquadA[7];
biquadA[7] = (inputSampleL * biquadA[3]) - (tempSampleL * biquadA[5]) + biquadA[8];
biquadA[8] = (inputSampleL * biquadA[4]) - (tempSampleL * biquadA[6]);
inputSampleL = tempSampleL; //like mono AU, 7 and 8 store L channel
double tempSampleR = (inputSampleR * biquadA[2]) + biquadA[9];
biquadA[9] = (inputSampleR * biquadA[3]) - (tempSampleR * biquadA[5]) + biquadA[10];
biquadA[10] = (inputSampleR * biquadA[4]) - (tempSampleR * biquadA[6]);
inputSampleR = tempSampleR; //note: 9 and 10 store the R channel
inputSampleL *= wet;
inputSampleR *= wet;
//we're going to use this as a kind of balance since the reverb buildup can be so large
inputSampleL = sin(inputSampleL);
inputSampleR = sin(inputSampleR);
double allpassIL = inputSampleL;
double allpassJL = inputSampleL;
double allpassKL = inputSampleL;
double allpassLL = inputSampleL;
double allpassIR = inputSampleR;
double allpassJR = inputSampleR;
double allpassKR = inputSampleR;
double allpassLR = inputSampleR;
int allpasstemp = countI + 1;
if (allpasstemp < 0 || allpasstemp > delayI) {allpasstemp = 0;}
allpassIL -= aIL[allpasstemp]*0.5;
aIL[countI] = allpassIL;
allpassIL *= 0.5;
allpassIR -= aIR[allpasstemp]*0.5;
aIR[countI] = allpassIR;
allpassIR *= 0.5;
countI++; if (countI < 0 || countI > delayI) {countI = 0;}
allpassIL += (aIL[countI]);
allpassIR += (aIR[countI]);
allpasstemp = countJ + 1;
if (allpasstemp < 0 || allpasstemp > delayJ) {allpasstemp = 0;}
allpassJL -= aJL[allpasstemp]*0.5;
aJL[countJ] = allpassJL;
allpassJL *= 0.5;
allpassJR -= aJR[allpasstemp]*0.5;
aJR[countJ] = allpassJR;
allpassJR *= 0.5;
countJ++; if (countJ < 0 || countJ > delayJ) {countJ = 0;}
allpassJL += (aJL[countJ]);
allpassJR += (aJR[countJ]);
allpasstemp = countK + 1;
if (allpasstemp < 0 || allpasstemp > delayK) {allpasstemp = 0;}
allpassKL -= aKL[allpasstemp]*0.5;
aKL[countK] = allpassKL;
allpassKL *= 0.5;
allpassKR -= aKR[allpasstemp]*0.5;
aKR[countK] = allpassKR;
allpassKR *= 0.5;
countK++; if (countK < 0 || countK > delayK) {countK = 0;}
allpassKL += (aKL[countK]);
allpassKR += (aKR[countK]);
allpasstemp = countL + 1;
if (allpasstemp < 0 || allpasstemp > delayL) {allpasstemp = 0;}
allpassLL -= aLL[allpasstemp]*0.5;
aLL[countL] = allpassLL;
allpassLL *= 0.5;
allpassLR -= aLR[allpasstemp]*0.5;
aLR[countL] = allpassLR;
allpassLR *= 0.5;
countL++; if (countL < 0 || countL > delayL) {countL = 0;}
allpassLL += (aLL[countL]);
allpassLR += (aLR[countL]);
//the big allpass in front of everything
aAL[countA] = allpassLL + feedbackAL;
aBL[countB] = allpassKL + feedbackBL;
aCL[countC] = allpassJL + feedbackCL;
aDL[countD] = allpassIL + feedbackDL;
aEL[countE] = allpassIL + feedbackEL;
aFL[countF] = allpassJL + feedbackFL;
aGL[countG] = allpassKL + feedbackGL;
aHL[countH] = allpassLL + feedbackHL; //L
aAR[countA] = allpassLR + feedbackAR;
aBR[countB] = allpassKR + feedbackBR;
aCR[countC] = allpassJR + feedbackCR;
aDR[countD] = allpassIR + feedbackDR;
aER[countE] = allpassIR + feedbackER;
aFR[countF] = allpassJR + feedbackFR;
aGR[countG] = allpassKR + feedbackGR;
aHR[countH] = allpassLR + feedbackHR; //R
countA++; if (countA < 0 || countA > delayA) {countA = 0;}
countB++; if (countB < 0 || countB > delayB) {countB = 0;}
countC++; if (countC < 0 || countC > delayC) {countC = 0;}
countD++; if (countD < 0 || countD > delayD) {countD = 0;}
countE++; if (countE < 0 || countE > delayE) {countE = 0;}
countF++; if (countF < 0 || countF > delayF) {countF = 0;}
countG++; if (countG < 0 || countG > delayG) {countG = 0;}
countH++; if (countH < 0 || countH > delayH) {countH = 0;}
//the Householder matrices (shared between channels, offset is stereo)
vibAL += (depthA * vibSpeed);
vibBL += (depthB * vibSpeed);
vibCL += (depthC * vibSpeed);
vibDL += (depthD * vibSpeed);
vibEL += (depthE * vibSpeed);
vibFL += (depthF * vibSpeed);
vibGL += (depthG * vibSpeed);
vibHL += (depthH * vibSpeed); //L
vibAR += (depthA * vibSpeed);
vibBR += (depthB * vibSpeed);
vibCR += (depthC * vibSpeed);
vibDR += (depthD * vibSpeed);
vibER += (depthE * vibSpeed);
vibFR += (depthF * vibSpeed);
vibGR += (depthG * vibSpeed);
vibHR += (depthH * vibSpeed); //R
//Depth is shared, but each started at a random position
double offsetAL = (sin(vibAL)+1.0)*vibDepth;
double offsetBL = (sin(vibBL)+1.0)*vibDepth;
double offsetCL = (sin(vibCL)+1.0)*vibDepth;
double offsetDL = (sin(vibDL)+1.0)*vibDepth;
double offsetEL = (sin(vibEL)+1.0)*vibDepth;
double offsetFL = (sin(vibFL)+1.0)*vibDepth;
double offsetGL = (sin(vibGL)+1.0)*vibDepth;
double offsetHL = (sin(vibHL)+1.0)*vibDepth; //L
double offsetAR = (sin(vibAR)+1.0)*vibDepth;
double offsetBR = (sin(vibBR)+1.0)*vibDepth;
double offsetCR = (sin(vibCR)+1.0)*vibDepth;
double offsetDR = (sin(vibDR)+1.0)*vibDepth;
double offsetER = (sin(vibER)+1.0)*vibDepth;
double offsetFR = (sin(vibFR)+1.0)*vibDepth;
double offsetGR = (sin(vibGR)+1.0)*vibDepth;
double offsetHR = (sin(vibHR)+1.0)*vibDepth; //R
int workingAL = countA + offsetAL;
int workingBL = countB + offsetBL;
int workingCL = countC + offsetCL;
int workingDL = countD + offsetDL;
int workingEL = countE + offsetEL;
int workingFL = countF + offsetFL;
int workingGL = countG + offsetGL;
int workingHL = countH + offsetHL; //L
int workingAR = countA + offsetAR;
int workingBR = countB + offsetBR;
int workingCR = countC + offsetCR;
int workingDR = countD + offsetDR;
int workingER = countE + offsetER;
int workingFR = countF + offsetFR;
int workingGR = countG + offsetGR;
int workingHR = countH + offsetHR; //R
double interpolAL = (aAL[workingAL-((workingAL > delayA)?delayA+1:0)] * (1-(offsetAL-floor(offsetAL))) );
interpolAL += (aAL[workingAL+1-((workingAL+1 > delayA)?delayA+1:0)] * ((offsetAL-floor(offsetAL))) );
double interpolBL = (aBL[workingBL-((workingBL > delayB)?delayB+1:0)] * (1-(offsetBL-floor(offsetBL))) );
interpolBL += (aBL[workingBL+1-((workingBL+1 > delayB)?delayB+1:0)] * ((offsetBL-floor(offsetBL))) );
double interpolCL = (aCL[workingCL-((workingCL > delayC)?delayC+1:0)] * (1-(offsetCL-floor(offsetCL))) );
interpolCL += (aCL[workingCL+1-((workingCL+1 > delayC)?delayC+1:0)] * ((offsetCL-floor(offsetCL))) );
double interpolDL = (aDL[workingDL-((workingDL > delayD)?delayD+1:0)] * (1-(offsetDL-floor(offsetDL))) );
interpolDL += (aDL[workingDL+1-((workingDL+1 > delayD)?delayD+1:0)] * ((offsetDL-floor(offsetDL))) );
double interpolEL = (aEL[workingEL-((workingEL > delayE)?delayE+1:0)] * (1-(offsetEL-floor(offsetEL))) );
interpolEL += (aEL[workingEL+1-((workingEL+1 > delayE)?delayE+1:0)] * ((offsetEL-floor(offsetEL))) );
double interpolFL = (aFL[workingFL-((workingFL > delayF)?delayF+1:0)] * (1-(offsetFL-floor(offsetFL))) );
interpolFL += (aFL[workingFL+1-((workingFL+1 > delayF)?delayF+1:0)] * ((offsetFL-floor(offsetFL))) );
double interpolGL = (aGL[workingGL-((workingGL > delayG)?delayG+1:0)] * (1-(offsetGL-floor(offsetGL))) );
interpolGL += (aGL[workingGL+1-((workingGL+1 > delayG)?delayG+1:0)] * ((offsetGL-floor(offsetGL))) );
double interpolHL = (aHL[workingHL-((workingHL > delayH)?delayH+1:0)] * (1-(offsetHL-floor(offsetHL))) );
interpolHL += (aHL[workingHL+1-((workingHL+1 > delayH)?delayH+1:0)] * ((offsetHL-floor(offsetHL))) );
//L
double interpolAR = (aAR[workingAR-((workingAR > delayA)?delayA+1:0)] * (1-(offsetAR-floor(offsetAR))) );
interpolAR += (aAR[workingAR+1-((workingAR+1 > delayA)?delayA+1:0)] * ((offsetAR-floor(offsetAR))) );
double interpolBR = (aBR[workingBR-((workingBR > delayB)?delayB+1:0)] * (1-(offsetBR-floor(offsetBR))) );
interpolBR += (aBR[workingBR+1-((workingBR+1 > delayB)?delayB+1:0)] * ((offsetBR-floor(offsetBR))) );
double interpolCR = (aCR[workingCR-((workingCR > delayC)?delayC+1:0)] * (1-(offsetCR-floor(offsetCR))) );
interpolCR += (aCR[workingCR+1-((workingCR+1 > delayC)?delayC+1:0)] * ((offsetCR-floor(offsetCR))) );
double interpolDR = (aDR[workingDR-((workingDR > delayD)?delayD+1:0)] * (1-(offsetDR-floor(offsetDR))) );
interpolDR += (aDR[workingDR+1-((workingDR+1 > delayD)?delayD+1:0)] * ((offsetDR-floor(offsetDR))) );
double interpolER = (aER[workingER-((workingER > delayE)?delayE+1:0)] * (1-(offsetER-floor(offsetER))) );
interpolER += (aER[workingER+1-((workingER+1 > delayE)?delayE+1:0)] * ((offsetER-floor(offsetER))) );
double interpolFR = (aFR[workingFR-((workingFR > delayF)?delayF+1:0)] * (1-(offsetFR-floor(offsetFR))) );
interpolFR += (aFR[workingFR+1-((workingFR+1 > delayF)?delayF+1:0)] * ((offsetFR-floor(offsetFR))) );
double interpolGR = (aGR[workingGR-((workingGR > delayG)?delayG+1:0)] * (1-(offsetGR-floor(offsetGR))) );
interpolGR += (aGR[workingGR+1-((workingGR+1 > delayG)?delayG+1:0)] * ((offsetGR-floor(offsetGR))) );
double interpolHR = (aHR[workingHR-((workingHR > delayH)?delayH+1:0)] * (1-(offsetHR-floor(offsetHR))) );
interpolHR += (aHR[workingHR+1-((workingHR+1 > delayH)?delayH+1:0)] * ((offsetHR-floor(offsetHR))) );
//R
interpolAL = ((1.0-blend)*interpolAL)+(aAL[workingAL-((workingAL > delayA)?delayA+1:0)]*blend);
interpolBL = ((1.0-blend)*interpolBL)+(aBL[workingBL-((workingBL > delayB)?delayB+1:0)]*blend);
interpolCL = ((1.0-blend)*interpolCL)+(aCL[workingCL-((workingCL > delayC)?delayC+1:0)]*blend);
interpolDL = ((1.0-blend)*interpolDL)+(aDL[workingDL-((workingDL > delayD)?delayD+1:0)]*blend);
interpolEL = ((1.0-blend)*interpolEL)+(aEL[workingEL-((workingEL > delayE)?delayE+1:0)]*blend);
interpolFL = ((1.0-blend)*interpolFL)+(aFL[workingFL-((workingFL > delayF)?delayF+1:0)]*blend);
interpolGL = ((1.0-blend)*interpolGL)+(aGL[workingGL-((workingGL > delayG)?delayG+1:0)]*blend);
interpolHL = ((1.0-blend)*interpolHL)+(aHL[workingHL-((workingHL > delayH)?delayH+1:0)]*blend); //L
interpolAR = ((1.0-blend)*interpolAR)+(aAR[workingAR-((workingAR > delayA)?delayA+1:0)]*blend);
interpolBR = ((1.0-blend)*interpolBR)+(aBR[workingBR-((workingBR > delayB)?delayB+1:0)]*blend);
interpolCR = ((1.0-blend)*interpolCR)+(aCR[workingCR-((workingCR > delayC)?delayC+1:0)]*blend);
interpolDR = ((1.0-blend)*interpolDR)+(aDR[workingDR-((workingDR > delayD)?delayD+1:0)]*blend);
interpolER = ((1.0-blend)*interpolER)+(aER[workingER-((workingER > delayE)?delayE+1:0)]*blend);
interpolFR = ((1.0-blend)*interpolFR)+(aFR[workingFR-((workingFR > delayF)?delayF+1:0)]*blend);
interpolGR = ((1.0-blend)*interpolGR)+(aGR[workingGR-((workingGR > delayG)?delayG+1:0)]*blend);
interpolHR = ((1.0-blend)*interpolHR)+(aHR[workingHR-((workingHR > delayH)?delayH+1:0)]*blend); //R
feedbackAL = (interpolAL - (interpolBL + interpolCL + interpolDL)) * regen;
feedbackBL = (interpolBL - (interpolAL + interpolCL + interpolDL)) * regen;
feedbackCL = (interpolCL - (interpolAL + interpolBL + interpolDL)) * regen;
feedbackDL = (interpolDL - (interpolAL + interpolBL + interpolCL)) * regen; //Householder feedback matrix, L
feedbackEL = (interpolEL - (interpolFL + interpolGL + interpolHL)) * regen;
feedbackFL = (interpolFL - (interpolEL + interpolGL + interpolHL)) * regen;
feedbackGL = (interpolGL - (interpolEL + interpolFL + interpolHL)) * regen;
feedbackHL = (interpolHL - (interpolEL + interpolFL + interpolGL)) * regen; //Householder feedback matrix, L
feedbackAR = (interpolAR - (interpolBR + interpolCR + interpolDR)) * regen;
feedbackBR = (interpolBR - (interpolAR + interpolCR + interpolDR)) * regen;
feedbackCR = (interpolCR - (interpolAR + interpolBR + interpolDR)) * regen;
feedbackDR = (interpolDR - (interpolAR + interpolBR + interpolCR)) * regen; //Householder feedback matrix, R
feedbackER = (interpolER - (interpolFR + interpolGR + interpolHR)) * regen;
feedbackFR = (interpolFR - (interpolER + interpolGR + interpolHR)) * regen;
feedbackGR = (interpolGR - (interpolER + interpolFR + interpolHR)) * regen;
feedbackHR = (interpolHR - (interpolER + interpolFR + interpolGR)) * regen; //Householder feedback matrix, R
inputSampleL = (interpolAL + interpolBL + interpolCL + interpolDL + interpolEL + interpolFL + interpolGL + interpolHL)/8.0;
inputSampleR = (interpolAR + interpolBR + interpolCR + interpolDR + interpolER + interpolFR + interpolGR + interpolHR)/8.0;
tempSampleL = (inputSampleL * biquadB[2]) + biquadB[7];
biquadB[7] = (inputSampleL * biquadB[3]) - (tempSampleL * biquadB[5]) + biquadB[8];
biquadB[8] = (inputSampleL * biquadB[4]) - (tempSampleL * biquadB[6]);
inputSampleL = tempSampleL; //like mono AU, 7 and 8 store L channel
tempSampleR = (inputSampleR * biquadB[2]) + biquadB[9];
biquadB[9] = (inputSampleR * biquadB[3]) - (tempSampleR * biquadB[5]) + biquadB[10];
biquadB[10] = (inputSampleR * biquadB[4]) - (tempSampleR * biquadB[6]);
inputSampleR = tempSampleR; //note: 9 and 10 store the R channel
if (inputSampleL > 1.0) inputSampleL = 1.0;
if (inputSampleL < -1.0) inputSampleL = -1.0;
if (inputSampleR > 1.0) inputSampleR = 1.0;
if (inputSampleR < -1.0) inputSampleR = -1.0;
//without this, you can get a NaN condition where it spits out DC offset at full blast!
inputSampleL = asin(inputSampleL);
inputSampleR = asin(inputSampleR);
tempSampleL = (inputSampleL * biquadC[2]) + biquadC[7];
biquadC[7] = (inputSampleL * biquadC[3]) - (tempSampleL * biquadC[5]) + biquadC[8];
biquadC[8] = (inputSampleL * biquadC[4]) - (tempSampleL * biquadC[6]);
inputSampleL = tempSampleL; //like mono AU, 7 and 8 store L channel
tempSampleR = (inputSampleR * biquadC[2]) + biquadC[9];
biquadC[9] = (inputSampleR * biquadC[3]) - (tempSampleR * biquadC[5]) + biquadC[10];
biquadC[10] = (inputSampleR * biquadC[4]) - (tempSampleR * biquadC[6]);
inputSampleR = tempSampleR; //note: 9 and 10 store the R channel
if (wet !=1.0) {
inputSampleL += (drySampleL * (1.0-wet));
inputSampleR += (drySampleR * (1.0-wet));
}
//begin 32 bit stereo floating point dither
int expon; frexpf((float)inputSampleL, &expon);
fpdL ^= fpdL << 13; fpdL ^= fpdL >> 17; fpdL ^= fpdL << 5;
inputSampleL += ((double(fpdL)-uint32_t(0x7fffffff)) * 5.5e-36l * pow(2,expon+62));
frexpf((float)inputSampleR, &expon);
fpdR ^= fpdR << 13; fpdR ^= fpdR >> 17; fpdR ^= fpdR << 5;
inputSampleR += ((double(fpdR)-uint32_t(0x7fffffff)) * 5.5e-36l * pow(2,expon+62));
//end 32 bit stereo floating point dither
*out1 = inputSampleL;
*out2 = inputSampleR;
*in1++;
*in2++;
*out1++;
*out2++;
}
}
void Reverb::processDoubleReplacing(double **inputs, double **outputs, VstInt32 sampleFrames)
{
double* in1 = inputs[0];
double* in2 = inputs[1];
double* out1 = outputs[0];
double* out2 = outputs[1];
double big = A;
double wet = B;
double vibSpeed = 0.1;
double vibDepth = 7.0;
double size = (pow(big,2)*75.0)+25.0;
double depthFactor = 1.0-pow((1.0-(0.82-(((1.0-big)*0.7)+(size*0.002)))),4);
double blend = 0.955-(size*0.007);
double regen = depthFactor * 0.5;
delayA = 79*size;
delayB = 73*size;
delayC = 71*size;
delayD = 67*size;
delayE = 61*size;
delayF = 59*size;
delayG = 53*size;
delayH = 47*size;
delayI = 43*size;
delayJ = 41*size;
delayK = 37*size;
delayL = 31*size;
delayM = 29*size;
biquadC[0] = biquadB[0] = biquadA[0] = (10000.0-(big*wet*3000.0))/getSampleRate();
biquadA[1] = 1.618033988749894848204586;
biquadB[1] = 0.618033988749894848204586;
biquadC[1] = 0.5;
double K = tan(M_PI * biquadA[0]); //lowpass
double norm = 1.0 / (1.0 + K / biquadA[1] + K * K);
biquadA[2] = K * K * norm;
biquadA[3] = 2.0 * biquadA[2];
biquadA[4] = biquadA[2];
biquadA[5] = 2.0 * (K * K - 1.0) * norm;
biquadA[6] = (1.0 - K / biquadA[1] + K * K) * norm;
K = tan(M_PI * biquadA[0]);
norm = 1.0 / (1.0 + K / biquadB[1] + K * K);
biquadB[2] = K * K * norm;
biquadB[3] = 2.0 * biquadB[2];
biquadB[4] = biquadB[2];
biquadB[5] = 2.0 * (K * K - 1.0) * norm;
biquadB[6] = (1.0 - K / biquadB[1] + K * K) * norm;
K = tan(M_PI * biquadC[0]);
norm = 1.0 / (1.0 + K / biquadC[1] + K * K);
biquadC[2] = K * K * norm;
biquadC[3] = 2.0 * biquadC[2];
biquadC[4] = biquadC[2];
biquadC[5] = 2.0 * (K * K - 1.0) * norm;
biquadC[6] = (1.0 - K / biquadC[1] + K * K) * norm;
while (--sampleFrames >= 0)
{
double inputSampleL = *in1;
double inputSampleR = *in2;
if (fabs(inputSampleL)<1.18e-23) inputSampleL = fpdL * 1.18e-17;
if (fabs(inputSampleR)<1.18e-23) inputSampleR = fpdR * 1.18e-17;
double drySampleL = inputSampleL;
double drySampleR = inputSampleR;
aML[countM] = inputSampleL;
aMR[countM] = inputSampleR;
countM++; if (countM < 0 || countM > delayM) {countM = 0;}
inputSampleL = aML[countM];
inputSampleR = aMR[countM];
//predelay
double tempSampleL = (inputSampleL * biquadA[2]) + biquadA[7];
biquadA[7] = (inputSampleL * biquadA[3]) - (tempSampleL * biquadA[5]) + biquadA[8];
biquadA[8] = (inputSampleL * biquadA[4]) - (tempSampleL * biquadA[6]);
inputSampleL = tempSampleL; //like mono AU, 7 and 8 store L channel
double tempSampleR = (inputSampleR * biquadA[2]) + biquadA[9];
biquadA[9] = (inputSampleR * biquadA[3]) - (tempSampleR * biquadA[5]) + biquadA[10];
biquadA[10] = (inputSampleR * biquadA[4]) - (tempSampleR * biquadA[6]);
inputSampleR = tempSampleR; //note: 9 and 10 store the R channel
inputSampleL *= wet;
inputSampleR *= wet;
//we're going to use this as a kind of balance since the reverb buildup can be so large
inputSampleL = sin(inputSampleL);
inputSampleR = sin(inputSampleR);
double allpassIL = inputSampleL;
double allpassJL = inputSampleL;
double allpassKL = inputSampleL;
double allpassLL = inputSampleL;
double allpassIR = inputSampleR;
double allpassJR = inputSampleR;
double allpassKR = inputSampleR;
double allpassLR = inputSampleR;
int allpasstemp = countI + 1;
if (allpasstemp < 0 || allpasstemp > delayI) {allpasstemp = 0;}
allpassIL -= aIL[allpasstemp]*0.5;
aIL[countI] = allpassIL;
allpassIL *= 0.5;
allpassIR -= aIR[allpasstemp]*0.5;
aIR[countI] = allpassIR;
allpassIR *= 0.5;
countI++; if (countI < 0 || countI > delayI) {countI = 0;}
allpassIL += (aIL[countI]);
allpassIR += (aIR[countI]);
allpasstemp = countJ + 1;
if (allpasstemp < 0 || allpasstemp > delayJ) {allpasstemp = 0;}
allpassJL -= aJL[allpasstemp]*0.5;
aJL[countJ] = allpassJL;
allpassJL *= 0.5;
allpassJR -= aJR[allpasstemp]*0.5;
aJR[countJ] = allpassJR;
allpassJR *= 0.5;
countJ++; if (countJ < 0 || countJ > delayJ) {countJ = 0;}
allpassJL += (aJL[countJ]);
allpassJR += (aJR[countJ]);
allpasstemp = countK + 1;
if (allpasstemp < 0 || allpasstemp > delayK) {allpasstemp = 0;}
allpassKL -= aKL[allpasstemp]*0.5;
aKL[countK] = allpassKL;
allpassKL *= 0.5;
allpassKR -= aKR[allpasstemp]*0.5;
aKR[countK] = allpassKR;
allpassKR *= 0.5;
countK++; if (countK < 0 || countK > delayK) {countK = 0;}
allpassKL += (aKL[countK]);
allpassKR += (aKR[countK]);
allpasstemp = countL + 1;
if (allpasstemp < 0 || allpasstemp > delayL) {allpasstemp = 0;}
allpassLL -= aLL[allpasstemp]*0.5;
aLL[countL] = allpassLL;
allpassLL *= 0.5;
allpassLR -= aLR[allpasstemp]*0.5;
aLR[countL] = allpassLR;
allpassLR *= 0.5;
countL++; if (countL < 0 || countL > delayL) {countL = 0;}
allpassLL += (aLL[countL]);
allpassLR += (aLR[countL]);
//the big allpass in front of everything
aAL[countA] = allpassLL + feedbackAL;
aBL[countB] = allpassKL + feedbackBL;
aCL[countC] = allpassJL + feedbackCL;
aDL[countD] = allpassIL + feedbackDL;
aEL[countE] = allpassIL + feedbackEL;
aFL[countF] = allpassJL + feedbackFL;
aGL[countG] = allpassKL + feedbackGL;
aHL[countH] = allpassLL + feedbackHL; //L
aAR[countA] = allpassLR + feedbackAR;
aBR[countB] = allpassKR + feedbackBR;
aCR[countC] = allpassJR + feedbackCR;
aDR[countD] = allpassIR + feedbackDR;
aER[countE] = allpassIR + feedbackER;
aFR[countF] = allpassJR + feedbackFR;
aGR[countG] = allpassKR + feedbackGR;
aHR[countH] = allpassLR + feedbackHR; //R
countA++; if (countA < 0 || countA > delayA) {countA = 0;}
countB++; if (countB < 0 || countB > delayB) {countB = 0;}
countC++; if (countC < 0 || countC > delayC) {countC = 0;}
countD++; if (countD < 0 || countD > delayD) {countD = 0;}
countE++; if (countE < 0 || countE > delayE) {countE = 0;}
countF++; if (countF < 0 || countF > delayF) {countF = 0;}
countG++; if (countG < 0 || countG > delayG) {countG = 0;}
countH++; if (countH < 0 || countH > delayH) {countH = 0;}
//the Householder matrices (shared between channels, offset is stereo)
vibAL += (depthA * vibSpeed);
vibBL += (depthB * vibSpeed);
vibCL += (depthC * vibSpeed);
vibDL += (depthD * vibSpeed);
vibEL += (depthE * vibSpeed);
vibFL += (depthF * vibSpeed);
vibGL += (depthG * vibSpeed);
vibHL += (depthH * vibSpeed); //L
vibAR += (depthA * vibSpeed);
vibBR += (depthB * vibSpeed);
vibCR += (depthC * vibSpeed);
vibDR += (depthD * vibSpeed);
vibER += (depthE * vibSpeed);
vibFR += (depthF * vibSpeed);
vibGR += (depthG * vibSpeed);
vibHR += (depthH * vibSpeed); //R
//Depth is shared, but each started at a random position
double offsetAL = (sin(vibAL)+1.0)*vibDepth;
double offsetBL = (sin(vibBL)+1.0)*vibDepth;
double offsetCL = (sin(vibCL)+1.0)*vibDepth;
double offsetDL = (sin(vibDL)+1.0)*vibDepth;
double offsetEL = (sin(vibEL)+1.0)*vibDepth;
double offsetFL = (sin(vibFL)+1.0)*vibDepth;
double offsetGL = (sin(vibGL)+1.0)*vibDepth;
double offsetHL = (sin(vibHL)+1.0)*vibDepth; //L
double offsetAR = (sin(vibAR)+1.0)*vibDepth;
double offsetBR = (sin(vibBR)+1.0)*vibDepth;
double offsetCR = (sin(vibCR)+1.0)*vibDepth;
double offsetDR = (sin(vibDR)+1.0)*vibDepth;
double offsetER = (sin(vibER)+1.0)*vibDepth;
double offsetFR = (sin(vibFR)+1.0)*vibDepth;
double offsetGR = (sin(vibGR)+1.0)*vibDepth;
double offsetHR = (sin(vibHR)+1.0)*vibDepth; //R
int workingAL = countA + offsetAL;
int workingBL = countB + offsetBL;
int workingCL = countC + offsetCL;
int workingDL = countD + offsetDL;
int workingEL = countE + offsetEL;
int workingFL = countF + offsetFL;
int workingGL = countG + offsetGL;
int workingHL = countH + offsetHL; //L
int workingAR = countA + offsetAR;
int workingBR = countB + offsetBR;
int workingCR = countC + offsetCR;
int workingDR = countD + offsetDR;
int workingER = countE + offsetER;
int workingFR = countF + offsetFR;
int workingGR = countG + offsetGR;
int workingHR = countH + offsetHR; //R
double interpolAL = (aAL[workingAL-((workingAL > delayA)?delayA+1:0)] * (1-(offsetAL-floor(offsetAL))) );
interpolAL += (aAL[workingAL+1-((workingAL+1 > delayA)?delayA+1:0)] * ((offsetAL-floor(offsetAL))) );
double interpolBL = (aBL[workingBL-((workingBL > delayB)?delayB+1:0)] * (1-(offsetBL-floor(offsetBL))) );
interpolBL += (aBL[workingBL+1-((workingBL+1 > delayB)?delayB+1:0)] * ((offsetBL-floor(offsetBL))) );
double interpolCL = (aCL[workingCL-((workingCL > delayC)?delayC+1:0)] * (1-(offsetCL-floor(offsetCL))) );
interpolCL += (aCL[workingCL+1-((workingCL+1 > delayC)?delayC+1:0)] * ((offsetCL-floor(offsetCL))) );
double interpolDL = (aDL[workingDL-((workingDL > delayD)?delayD+1:0)] * (1-(offsetDL-floor(offsetDL))) );
interpolDL += (aDL[workingDL+1-((workingDL+1 > delayD)?delayD+1:0)] * ((offsetDL-floor(offsetDL))) );
double interpolEL = (aEL[workingEL-((workingEL > delayE)?delayE+1:0)] * (1-(offsetEL-floor(offsetEL))) );
interpolEL += (aEL[workingEL+1-((workingEL+1 > delayE)?delayE+1:0)] * ((offsetEL-floor(offsetEL))) );
double interpolFL = (aFL[workingFL-((workingFL > delayF)?delayF+1:0)] * (1-(offsetFL-floor(offsetFL))) );
interpolFL += (aFL[workingFL+1-((workingFL+1 > delayF)?delayF+1:0)] * ((offsetFL-floor(offsetFL))) );
double interpolGL = (aGL[workingGL-((workingGL > delayG)?delayG+1:0)] * (1-(offsetGL-floor(offsetGL))) );
interpolGL += (aGL[workingGL+1-((workingGL+1 > delayG)?delayG+1:0)] * ((offsetGL-floor(offsetGL))) );
double interpolHL = (aHL[workingHL-((workingHL > delayH)?delayH+1:0)] * (1-(offsetHL-floor(offsetHL))) );
interpolHL += (aHL[workingHL+1-((workingHL+1 > delayH)?delayH+1:0)] * ((offsetHL-floor(offsetHL))) );
//L
double interpolAR = (aAR[workingAR-((workingAR > delayA)?delayA+1:0)] * (1-(offsetAR-floor(offsetAR))) );
interpolAR += (aAR[workingAR+1-((workingAR+1 > delayA)?delayA+1:0)] * ((offsetAR-floor(offsetAR))) );
double interpolBR = (aBR[workingBR-((workingBR > delayB)?delayB+1:0)] * (1-(offsetBR-floor(offsetBR))) );
interpolBR += (aBR[workingBR+1-((workingBR+1 > delayB)?delayB+1:0)] * ((offsetBR-floor(offsetBR))) );
double interpolCR = (aCR[workingCR-((workingCR > delayC)?delayC+1:0)] * (1-(offsetCR-floor(offsetCR))) );
interpolCR += (aCR[workingCR+1-((workingCR+1 > delayC)?delayC+1:0)] * ((offsetCR-floor(offsetCR))) );
double interpolDR = (aDR[workingDR-((workingDR > delayD)?delayD+1:0)] * (1-(offsetDR-floor(offsetDR))) );
interpolDR += (aDR[workingDR+1-((workingDR+1 > delayD)?delayD+1:0)] * ((offsetDR-floor(offsetDR))) );
double interpolER = (aER[workingER-((workingER > delayE)?delayE+1:0)] * (1-(offsetER-floor(offsetER))) );
interpolER += (aER[workingER+1-((workingER+1 > delayE)?delayE+1:0)] * ((offsetER-floor(offsetER))) );
double interpolFR = (aFR[workingFR-((workingFR > delayF)?delayF+1:0)] * (1-(offsetFR-floor(offsetFR))) );
interpolFR += (aFR[workingFR+1-((workingFR+1 > delayF)?delayF+1:0)] * ((offsetFR-floor(offsetFR))) );
double interpolGR = (aGR[workingGR-((workingGR > delayG)?delayG+1:0)] * (1-(offsetGR-floor(offsetGR))) );
interpolGR += (aGR[workingGR+1-((workingGR+1 > delayG)?delayG+1:0)] * ((offsetGR-floor(offsetGR))) );
double interpolHR = (aHR[workingHR-((workingHR > delayH)?delayH+1:0)] * (1-(offsetHR-floor(offsetHR))) );
interpolHR += (aHR[workingHR+1-((workingHR+1 > delayH)?delayH+1:0)] * ((offsetHR-floor(offsetHR))) );
//R
interpolAL = ((1.0-blend)*interpolAL)+(aAL[workingAL-((workingAL > delayA)?delayA+1:0)]*blend);
interpolBL = ((1.0-blend)*interpolBL)+(aBL[workingBL-((workingBL > delayB)?delayB+1:0)]*blend);
interpolCL = ((1.0-blend)*interpolCL)+(aCL[workingCL-((workingCL > delayC)?delayC+1:0)]*blend);
interpolDL = ((1.0-blend)*interpolDL)+(aDL[workingDL-((workingDL > delayD)?delayD+1:0)]*blend);
interpolEL = ((1.0-blend)*interpolEL)+(aEL[workingEL-((workingEL > delayE)?delayE+1:0)]*blend);
interpolFL = ((1.0-blend)*interpolFL)+(aFL[workingFL-((workingFL > delayF)?delayF+1:0)]*blend);
interpolGL = ((1.0-blend)*interpolGL)+(aGL[workingGL-((workingGL > delayG)?delayG+1:0)]*blend);
interpolHL = ((1.0-blend)*interpolHL)+(aHL[workingHL-((workingHL > delayH)?delayH+1:0)]*blend); //L
interpolAR = ((1.0-blend)*interpolAR)+(aAR[workingAR-((workingAR > delayA)?delayA+1:0)]*blend);
interpolBR = ((1.0-blend)*interpolBR)+(aBR[workingBR-((workingBR > delayB)?delayB+1:0)]*blend);
interpolCR = ((1.0-blend)*interpolCR)+(aCR[workingCR-((workingCR > delayC)?delayC+1:0)]*blend);
interpolDR = ((1.0-blend)*interpolDR)+(aDR[workingDR-((workingDR > delayD)?delayD+1:0)]*blend);
interpolER = ((1.0-blend)*interpolER)+(aER[workingER-((workingER > delayE)?delayE+1:0)]*blend);
interpolFR = ((1.0-blend)*interpolFR)+(aFR[workingFR-((workingFR > delayF)?delayF+1:0)]*blend);
interpolGR = ((1.0-blend)*interpolGR)+(aGR[workingGR-((workingGR > delayG)?delayG+1:0)]*blend);
interpolHR = ((1.0-blend)*interpolHR)+(aHR[workingHR-((workingHR > delayH)?delayH+1:0)]*blend); //R
feedbackAL = (interpolAL - (interpolBL + interpolCL + interpolDL)) * regen;
feedbackBL = (interpolBL - (interpolAL + interpolCL + interpolDL)) * regen;
feedbackCL = (interpolCL - (interpolAL + interpolBL + interpolDL)) * regen;
feedbackDL = (interpolDL - (interpolAL + interpolBL + interpolCL)) * regen; //Householder feedback matrix, L
feedbackEL = (interpolEL - (interpolFL + interpolGL + interpolHL)) * regen;
feedbackFL = (interpolFL - (interpolEL + interpolGL + interpolHL)) * regen;
feedbackGL = (interpolGL - (interpolEL + interpolFL + interpolHL)) * regen;
feedbackHL = (interpolHL - (interpolEL + interpolFL + interpolGL)) * regen; //Householder feedback matrix, L
feedbackAR = (interpolAR - (interpolBR + interpolCR + interpolDR)) * regen;
feedbackBR = (interpolBR - (interpolAR + interpolCR + interpolDR)) * regen;
feedbackCR = (interpolCR - (interpolAR + interpolBR + interpolDR)) * regen;
feedbackDR = (interpolDR - (interpolAR + interpolBR + interpolCR)) * regen; //Householder feedback matrix, R
feedbackER = (interpolER - (interpolFR + interpolGR + interpolHR)) * regen;
feedbackFR = (interpolFR - (interpolER + interpolGR + interpolHR)) * regen;
feedbackGR = (interpolGR - (interpolER + interpolFR + interpolHR)) * regen;
feedbackHR = (interpolHR - (interpolER + interpolFR + interpolGR)) * regen; //Householder feedback matrix, R
inputSampleL = (interpolAL + interpolBL + interpolCL + interpolDL + interpolEL + interpolFL + interpolGL + interpolHL)/8.0;
inputSampleR = (interpolAR + interpolBR + interpolCR + interpolDR + interpolER + interpolFR + interpolGR + interpolHR)/8.0;
tempSampleL = (inputSampleL * biquadB[2]) + biquadB[7];
biquadB[7] = (inputSampleL * biquadB[3]) - (tempSampleL * biquadB[5]) + biquadB[8];
biquadB[8] = (inputSampleL * biquadB[4]) - (tempSampleL * biquadB[6]);
inputSampleL = tempSampleL; //like mono AU, 7 and 8 store L channel
tempSampleR = (inputSampleR * biquadB[2]) + biquadB[9];
biquadB[9] = (inputSampleR * biquadB[3]) - (tempSampleR * biquadB[5]) + biquadB[10];
biquadB[10] = (inputSampleR * biquadB[4]) - (tempSampleR * biquadB[6]);
inputSampleR = tempSampleR; //note: 9 and 10 store the R channel
if (inputSampleL > 1.0) inputSampleL = 1.0;
if (inputSampleL < -1.0) inputSampleL = -1.0;
if (inputSampleR > 1.0) inputSampleR = 1.0;
if (inputSampleR < -1.0) inputSampleR = -1.0;
//without this, you can get a NaN condition where it spits out DC offset at full blast!
inputSampleL = asin(inputSampleL);
inputSampleR = asin(inputSampleR);
tempSampleL = (inputSampleL * biquadC[2]) + biquadC[7];
biquadC[7] = (inputSampleL * biquadC[3]) - (tempSampleL * biquadC[5]) + biquadC[8];
biquadC[8] = (inputSampleL * biquadC[4]) - (tempSampleL * biquadC[6]);
inputSampleL = tempSampleL; //like mono AU, 7 and 8 store L channel
tempSampleR = (inputSampleR * biquadC[2]) + biquadC[9];
biquadC[9] = (inputSampleR * biquadC[3]) - (tempSampleR * biquadC[5]) + biquadC[10];
biquadC[10] = (inputSampleR * biquadC[4]) - (tempSampleR * biquadC[6]);
inputSampleR = tempSampleR; //note: 9 and 10 store the R channel
if (wet !=1.0) {
inputSampleL += (drySampleL * (1.0-wet));
inputSampleR += (drySampleR * (1.0-wet));
}
//begin 64 bit stereo floating point dither
//int expon; frexp((double)inputSampleL, &expon);
fpdL ^= fpdL << 13; fpdL ^= fpdL >> 17; fpdL ^= fpdL << 5;
//inputSampleL += ((double(fpdL)-uint32_t(0x7fffffff)) * 1.1e-44l * pow(2,expon+62));
//frexp((double)inputSampleR, &expon);
fpdR ^= fpdR << 13; fpdR ^= fpdR >> 17; fpdR ^= fpdR << 5;
//inputSampleR += ((double(fpdR)-uint32_t(0x7fffffff)) * 1.1e-44l * pow(2,expon+62));
//end 64 bit stereo floating point dither
*out1 = inputSampleL;
*out2 = inputSampleR;
*in1++;
*in2++;
*out1++;
*out2++;
}
}