github-starred/airwindows
2
0
Fork 0
mirror of https://github.com/airwindows/airwindows.git synced 2026-05-16 14:16:02 -06:00
Code Issues 33 Projects Packages Wiki Activity Actions
airwindows/plugins/WinVST/VerbThic/VerbThicProc.cpp
Christopher Johnson 824cfc024d VerbThic
2025-11-28 16:15:14 -05:00

718 lines
27 KiB
C++
Executable file
Raw Permalink Blame History

/* ========================================
* VerbThic - VerbThic.h
* Copyright (c) airwindows, Airwindows uses the MIT license
* ======================================== */
#ifndef __VerbThic_H
#include "VerbThic.h"
#endif
void VerbThic::processReplacing(float **inputs, float **outputs, VstInt32 sampleFrames)
{
float* in1 = inputs[0];
float* in2 = inputs[1];
float* out1 = outputs[0];
float* out2 = outputs[1];
double overallscale = 1.0;
overallscale /= 44100.0;
overallscale *= getSampleRate();
double reg4n = 0.03125+((1.0-pow(1.0-A,2.0))*0.03125);
double attenuate = 1.0 - (1.0-pow(1.0-A,2.0));
double derez = pow(B,2.0);
derez = fmin(fmax(derez/overallscale,0.0001),1.0);
int bezFraction = (int)(1.0/derez);
double bezTrim = (double)bezFraction/(bezFraction+1.0);
derez = 1.0 / bezFraction;
bezTrim = 1.0-(derez*bezTrim);
//the revision more accurately connects the bezier curves
double derezFreq = pow(C,2.0);
derezFreq = fmin(fmax(derezFreq/overallscale,0.0001),1.0);
int bezFreqFraction = (int)(1.0/derezFreq);
double bezFreqTrim = (double)bezFreqFraction/(bezFreqFraction+1.0);
derezFreq = 1.0 / bezFreqFraction;
bezFreqTrim = 1.0-(derezFreq*bezFreqTrim);
//the revision more accurately connects the bezier curves
double wider = D*2.0;
double wet = E;
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;
bez[bez_cycle] += derez;
bez[bez_SampL] += (inputSampleL*attenuate*derez);
bez[bez_SampR] += (inputSampleR*attenuate*derez);
if (bez[bez_cycle] > 1.0) { //hit the end point and we do a reverb sample
bez[bez_cycle] = 0.0;
double mainSampleL = bez[bez_SampL];
double dualmonoSampleL = bez[bez_SampR];
//workaround involves keeping the cross-matrix system,
//but for initial layering, each side gets each version
//making blends never quite line up as exactly the same.
//left verbs
a4AL[c4AL] = mainSampleL + (f4DR * reg4n);
a4BL[c4BL] = mainSampleL + (f4HR * reg4n);
a4CL[c4CL] = mainSampleL + (f4LR * reg4n);
a4DL[c4DL] = mainSampleL + (f4PR * reg4n);
b4AL[c4AL] = dualmonoSampleL + (g4AL * reg4n);
b4BL[c4BL] = dualmonoSampleL + (g4BL * reg4n);
b4CL[c4CL] = dualmonoSampleL + (g4CL * reg4n);
b4DL[c4DL] = dualmonoSampleL + (g4DL * reg4n);
c4AL++; if (c4AL < 0 || c4AL > d4A) c4AL = 0;
c4BL++; if (c4BL < 0 || c4BL > d4B) c4BL = 0;
c4CL++; if (c4CL < 0 || c4CL > d4C) c4CL = 0;
c4DL++; if (c4DL < 0 || c4DL > d4D) c4DL = 0;
double hA = a4AL[c4AL-((c4AL > d4A)?d4A+1:0)];
double hB = a4BL[c4BL-((c4BL > d4B)?d4B+1:0)];
double hC = a4CL[c4CL-((c4CL > d4C)?d4C+1:0)];
double hD = a4DL[c4DL-((c4DL > d4D)?d4D+1:0)];
a4EL[c4EL] = hA - (hB + hC + hD);
a4FL[c4FL] = hB - (hA + hC + hD);
a4GL[c4GL] = hC - (hA + hB + hD);
a4HL[c4HL] = hD - (hA + hB + hC);
hA = b4AL[c4AL-((c4AL > d4A)?d4A+1:0)];
hB = b4BL[c4BL-((c4BL > d4B)?d4B+1:0)];
hC = b4CL[c4CL-((c4CL > d4C)?d4C+1:0)];
hD = b4DL[c4DL-((c4DL > d4D)?d4D+1:0)];
b4EL[c4EL] = hA - (hB + hC + hD);
b4FL[c4FL] = hB - (hA + hC + hD);
b4GL[c4GL] = hC - (hA + hB + hD);
b4HL[c4HL] = hD - (hA + hB + hC);
c4EL++; if (c4EL < 0 || c4EL > d4E) c4EL = 0;
c4FL++; if (c4FL < 0 || c4FL > d4F) c4FL = 0;
c4GL++; if (c4GL < 0 || c4GL > d4G) c4GL = 0;
c4HL++; if (c4HL < 0 || c4HL > d4H) c4HL = 0;
hA = a4EL[c4EL-((c4EL > d4E)?d4E+1:0)];
hB = a4FL[c4FL-((c4FL > d4F)?d4F+1:0)];
hC = a4GL[c4GL-((c4GL > d4G)?d4G+1:0)];
hD = a4HL[c4HL-((c4HL > d4H)?d4H+1:0)];
a4IL[c4IL] = hA - (hB + hC + hD);
a4JL[c4JL] = hB - (hA + hC + hD);
a4KL[c4KL] = hC - (hA + hB + hD);
a4LL[c4LL] = hD - (hA + hB + hC);
hA = b4EL[c4EL-((c4EL > d4E)?d4E+1:0)];
hB = b4FL[c4FL-((c4FL > d4F)?d4F+1:0)];
hC = b4GL[c4GL-((c4GL > d4G)?d4G+1:0)];
hD = b4HL[c4HL-((c4HL > d4H)?d4H+1:0)];
b4IL[c4IL] = hA - (hB + hC + hD);
b4JL[c4JL] = hB - (hA + hC + hD);
b4KL[c4KL] = hC - (hA + hB + hD);
b4LL[c4LL] = hD - (hA + hB + hC);
c4IL++; if (c4IL < 0 || c4IL > d4I) c4IL = 0;
c4JL++; if (c4JL < 0 || c4JL > d4J) c4JL = 0;
c4KL++; if (c4KL < 0 || c4KL > d4K) c4KL = 0;
c4LL++; if (c4LL < 0 || c4LL > d4L) c4LL = 0;
hA = a4IL[c4IL-((c4IL > d4I)?d4I+1:0)];
hB = a4JL[c4JL-((c4JL > d4J)?d4J+1:0)];
hC = a4KL[c4KL-((c4KL > d4K)?d4K+1:0)];
hD = a4LL[c4LL-((c4LL > d4L)?d4L+1:0)];
a4ML[c4ML] = hA - (hB + hC + hD);
a4NL[c4NL] = hB - (hA + hC + hD);
a4OL[c4OL] = hC - (hA + hB + hD);
a4PL[c4PL] = hD - (hA + hB + hC);
hA = b4IL[c4IL-((c4IL > d4I)?d4I+1:0)];
hB = b4JL[c4JL-((c4JL > d4J)?d4J+1:0)];
hC = b4KL[c4KL-((c4KL > d4K)?d4K+1:0)];
hD = b4LL[c4LL-((c4LL > d4L)?d4L+1:0)];
b4ML[c4ML] = hA - (hB + hC + hD);
b4NL[c4NL] = hB - (hA + hC + hD);
b4OL[c4OL] = hC - (hA + hB + hD);
b4PL[c4PL] = hD - (hA + hB + hC);
c4ML++; if (c4ML < 0 || c4ML > d4M) c4ML = 0;
c4NL++; if (c4NL < 0 || c4NL > d4N) c4NL = 0;
c4OL++; if (c4OL < 0 || c4OL > d4O) c4OL = 0;
c4PL++; if (c4PL < 0 || c4PL > d4P) c4PL = 0;
hA = a4ML[c4ML-((c4ML > d4M)?d4M+1:0)];
hB = a4NL[c4NL-((c4NL > d4N)?d4N+1:0)];
hC = a4OL[c4OL-((c4OL > d4O)?d4O+1:0)];
hD = a4PL[c4PL-((c4PL > d4P)?d4P+1:0)];
f4AL = hA - (hB + hC + hD);
f4BL = hB - (hA + hC + hD);
f4CL = hC - (hA + hB + hD);
f4DL = hD - (hA + hB + hC);//not actually crosschannel yet
mainSampleL = (hA + hB + hC + hD)*0.125;
hA = b4ML[c4ML-((c4ML > d4M)?d4M+1:0)];
hB = b4NL[c4NL-((c4NL > d4N)?d4N+1:0)];
hC = b4OL[c4OL-((c4OL > d4O)?d4O+1:0)];
hD = b4PL[c4PL-((c4PL > d4P)?d4P+1:0)];
g4AL = hA - (hB + hC + hD);
g4BL = hB - (hA + hC + hD);
g4CL = hC - (hA + hB + hD);
g4DL = hD - (hA + hB + hC);
dualmonoSampleL = (hA + hB + hC + hD)*0.125;
double mainSampleR = bez[bez_SampR]; //begin primary reverb
double dualmonoSampleR = bez[bez_SampL];
//right verbs
a4DR[c4DR] = mainSampleR + (f4AL * reg4n);
a4HR[c4HR] = mainSampleR + (f4BL * reg4n);
a4LR[c4LR] = mainSampleR + (f4CL * reg4n);
a4PR[c4PR] = mainSampleR + (f4DL * reg4n);
b4DR[c4DR] = dualmonoSampleR + (g4DR * reg4n);
b4HR[c4HR] = dualmonoSampleR + (g4HR * reg4n);
b4LR[c4LR] = dualmonoSampleR + (g4LR * reg4n);
b4PR[c4PR] = dualmonoSampleR + (g4PR * reg4n);
c4DR++; if (c4DR < 0 || c4DR > d4D) c4DR = 0;
c4HR++; if (c4HR < 0 || c4HR > d4H) c4HR = 0;
c4LR++; if (c4LR < 0 || c4LR > d4L) c4LR = 0;
c4PR++; if (c4PR < 0 || c4PR > d4P) c4PR = 0;
hA = a4DR[c4DR-((c4DR > d4D)?d4D+1:0)];
hB = a4HR[c4HR-((c4HR > d4H)?d4H+1:0)];
hC = a4LR[c4LR-((c4LR > d4L)?d4L+1:0)];
hD = a4PR[c4PR-((c4PR > d4P)?d4P+1:0)];
a4CR[c4CR] = hA - (hB + hC + hD);
a4GR[c4GR] = hB - (hA + hC + hD);
a4KR[c4KR] = hC - (hA + hB + hD);
a4OR[c4OR] = hD - (hA + hB + hC);
hA = b4DR[c4DR-((c4DR > d4D)?d4D+1:0)];
hB = b4HR[c4HR-((c4HR > d4H)?d4H+1:0)];
hC = b4LR[c4LR-((c4LR > d4L)?d4L+1:0)];
hD = b4PR[c4PR-((c4PR > d4P)?d4P+1:0)];
b4CR[c4CR] = hA - (hB + hC + hD);
b4GR[c4GR] = hB - (hA + hC + hD);
b4KR[c4KR] = hC - (hA + hB + hD);
b4OR[c4OR] = hD - (hA + hB + hC);
c4CR++; if (c4CR < 0 || c4CR > d4C) c4CR = 0;
c4GR++; if (c4GR < 0 || c4GR > d4G) c4GR = 0;
c4KR++; if (c4KR < 0 || c4KR > d4K) c4KR = 0;
c4OR++; if (c4OR < 0 || c4OR > d4O) c4OR = 0;
hA = a4CR[c4CR-((c4CR > d4C)?d4C+1:0)];
hB = a4GR[c4GR-((c4GR > d4G)?d4G+1:0)];
hC = a4KR[c4KR-((c4KR > d4K)?d4K+1:0)];
hD = a4OR[c4OR-((c4OR > d4O)?d4O+1:0)];
a4BR[c4BR] = hA - (hB + hC + hD);
a4FR[c4FR] = hB - (hA + hC + hD);
a4JR[c4JR] = hC - (hA + hB + hD);
a4NR[c4NR] = hD - (hA + hB + hC);
hA = b4CR[c4CR-((c4CR > d4C)?d4C+1:0)];
hB = b4GR[c4GR-((c4GR > d4G)?d4G+1:0)];
hC = b4KR[c4KR-((c4KR > d4K)?d4K+1:0)];
hD = b4OR[c4OR-((c4OR > d4O)?d4O+1:0)];
b4BR[c4BR] = hA - (hB + hC + hD);
b4FR[c4FR] = hB - (hA + hC + hD);
b4JR[c4JR] = hC - (hA + hB + hD);
b4NR[c4NR] = hD - (hA + hB + hC);
c4BR++; if (c4BR < 0 || c4BR > d4B) c4BR = 0;
c4FR++; if (c4FR < 0 || c4FR > d4F) c4FR = 0;
c4JR++; if (c4JR < 0 || c4JR > d4J) c4JR = 0;
c4NR++; if (c4NR < 0 || c4NR > d4N) c4NR = 0;
hA = a4BR[c4BR-((c4BR > d4B)?d4B+1:0)];
hB = a4FR[c4FR-((c4FR > d4F)?d4F+1:0)];
hC = a4JR[c4JR-((c4JR > d4J)?d4J+1:0)];
hD = a4NR[c4NR-((c4NR > d4N)?d4N+1:0)];
a4AR[c4AR] = hA - (hB + hC + hD);
a4ER[c4ER] = hB - (hA + hC + hD);
a4IR[c4IR] = hC - (hA + hB + hD);
a4MR[c4MR] = hD - (hA + hB + hC);
hA = b4BR[c4BR-((c4BR > d4B)?d4B+1:0)];
hB = b4FR[c4FR-((c4FR > d4F)?d4F+1:0)];
hC = b4JR[c4JR-((c4JR > d4J)?d4J+1:0)];
hD = b4NR[c4NR-((c4NR > d4N)?d4N+1:0)];
b4AR[c4AR] = hA - (hB + hC + hD);
b4ER[c4ER] = hB - (hA + hC + hD);
b4IR[c4IR] = hC - (hA + hB + hD);
b4MR[c4MR] = hD - (hA + hB + hC);
c4AR++; if (c4AR < 0 || c4AR > d4A) c4AR = 0;
c4ER++; if (c4ER < 0 || c4ER > d4E) c4ER = 0;
c4IR++; if (c4IR < 0 || c4IR > d4I) c4IR = 0;
c4MR++; if (c4MR < 0 || c4MR > d4M) c4MR = 0;
hA = a4AR[c4AR-((c4AR > d4A)?d4A+1:0)];
hB = a4ER[c4ER-((c4ER > d4E)?d4E+1:0)];
hC = a4IR[c4IR-((c4IR > d4I)?d4I+1:0)];
hD = a4MR[c4MR-((c4MR > d4M)?d4M+1:0)];
f4DR = hA - (hB + hC + hD);
f4HR = hB - (hA + hC + hD);
f4LR = hC - (hA + hB + hD);
f4PR = hD - (hA + hB + hC);
mainSampleR = (hA + hB + hC + hD)*0.125;
hA = b4AR[c4AR-((c4AR > d4A)?d4A+1:0)];
hB = b4ER[c4ER-((c4ER > d4E)?d4E+1:0)];
hC = b4IR[c4IR-((c4IR > d4I)?d4I+1:0)];
hD = b4MR[c4MR-((c4MR > d4M)?d4M+1:0)];
g4DR = hA - (hB + hC + hD);
g4HR = hB - (hA + hC + hD);
g4LR = hC - (hA + hB + hD);
g4PR = hD - (hA + hB + hC);
dualmonoSampleR = (hA + hB + hC + hD)*0.125;
//dual mono version is wider = 1.0 at the center
//with mainsample 0.0 and 2.0 (only at the edges)
//with mainsample out of phase when over 1.0
//couldn't re-do the arrays perfectly, so instead
//we keep exactly the same cross-matrix,
//but we flip the sides we're using for initial reverb.
//then, dualmono remains totally dualmono, and blend a bit in for wideness.
if (wider < 1.0) {
inputSampleL = (dualmonoSampleR*wider) + (mainSampleL*(1.0-wider));
inputSampleR = (dualmonoSampleL*wider) + (mainSampleR*(1.0-wider));
} else {
inputSampleL = (dualmonoSampleR*(2.0-wider)) + (mainSampleL*(wider-1.0));
inputSampleR = (dualmonoSampleL*(2.0-wider)) + (-mainSampleR*(wider-1.0));
}
inputSampleL = fmin(fmax(inputSampleL,-2.032610446872596),2.032610446872596);
long double X = inputSampleL * inputSampleL;
long double temp = inputSampleL * X;
inputSampleL -= (temp*0.125); temp *= X;
inputSampleL += (temp*0.0078125); temp *= X;
inputSampleL -= (temp*0.000244140625); temp *= X;
inputSampleL += (temp*0.000003814697265625); temp *= X;
inputSampleL -= (temp*0.0000000298023223876953125); temp *= X;
//purestsaturation: sine, except all the corrections
//retain mantissa of a long double increasing power function
inputSampleR = fmin(fmax(inputSampleR,-2.032610446872596),2.032610446872596);
X = inputSampleR * inputSampleR;
temp = inputSampleR * X;
inputSampleR -= (temp*0.125); temp *= X;
inputSampleR += (temp*0.0078125); temp *= X;
inputSampleR -= (temp*0.000244140625); temp *= X;
inputSampleR += (temp*0.000003814697265625); temp *= X;
inputSampleR -= (temp*0.0000000298023223876953125); temp *= X;
//purestsaturation: sine, except all the corrections
//retain mantissa of a long double increasing power function
bez[bez_CL] = bez[bez_BL];
bez[bez_BL] = bez[bez_AL];
bez[bez_AL] = inputSampleL;
bez[bez_SampL] = 0.0;
bez[bez_CR] = bez[bez_BR];
bez[bez_BR] = bez[bez_AR];
bez[bez_AR] = inputSampleR;
bez[bez_SampR] = 0.0;
}
double X = bez[bez_cycle]*bezTrim;
double CBL = (bez[bez_CL]*(1.0-X))+(bez[bez_BL]*X);
double CBR = (bez[bez_CR]*(1.0-X))+(bez[bez_BR]*X);
double BAL = (bez[bez_BL]*(1.0-X))+(bez[bez_AL]*X);
double BAR = (bez[bez_BR]*(1.0-X))+(bez[bez_AR]*X);
inputSampleL = (bez[bez_BL]+(CBL*(1.0-X))+(BAL*X))*-0.25;
inputSampleR = (bez[bez_BR]+(CBR*(1.0-X))+(BAR*X))*-0.25;
bezF[bez_cycle] += derezFreq;
bezF[bez_SampL] += (inputSampleL * derezFreq);
bezF[bez_SampR] += (inputSampleR * derezFreq);
if (bezF[bez_cycle] > 1.0) { //hit the end point and we do a filter sample
bezF[bez_cycle] = 0.0;
bezF[bez_CL] = bezF[bez_BL];
bezF[bez_BL] = bezF[bez_AL];
bezF[bez_AL] = bezF[bez_SampL];
bezF[bez_SampL] = 0.0;
bezF[bez_CR] = bezF[bez_BR];
bezF[bez_BR] = bezF[bez_AR];
bezF[bez_AR] = bezF[bez_SampR];
bezF[bez_SampR] = 0.0;
}
X = bezF[bez_cycle]*bezFreqTrim;
double CBLfreq = (bezF[bez_CL]*(1.0-X))+(bezF[bez_BL]*X);
double BALfreq = (bezF[bez_BL]*(1.0-X))+(bezF[bez_AL]*X);
inputSampleL = (bezF[bez_BL]+(CBLfreq*(1.0-X))+(BALfreq*X))*0.5;
double CBRfreq = (bezF[bez_CR]*(1.0-X))+(bezF[bez_BR]*X);
double BARfreq = (bezF[bez_BR]*(1.0-X))+(bezF[bez_AR]*X);
inputSampleR = (bezF[bez_BR]+(CBRfreq*(1.0-X))+(BARfreq*X))*0.5;
//filtering the reverb separately, after making it
inputSampleL = (inputSampleL * wet)+(drySampleL * (1.0-wet));
inputSampleR = (inputSampleR * wet)+(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 VerbThic::processDoubleReplacing(double **inputs, double **outputs, VstInt32 sampleFrames)
{
double* in1 = inputs[0];
double* in2 = inputs[1];
double* out1 = outputs[0];
double* out2 = outputs[1];
double overallscale = 1.0;
overallscale /= 44100.0;
overallscale *= getSampleRate();
double reg4n = 0.03125+((1.0-pow(1.0-A,2.0))*0.03125);
double attenuate = 1.0 - (1.0-pow(1.0-A,2.0));
double derez = pow(B,2.0);
derez = fmin(fmax(derez/overallscale,0.0001),1.0);
int bezFraction = (int)(1.0/derez);
double bezTrim = (double)bezFraction/(bezFraction+1.0);
derez = 1.0 / bezFraction;
bezTrim = 1.0-(derez*bezTrim);
//the revision more accurately connects the bezier curves
double derezFreq = pow(C,2.0);
derezFreq = fmin(fmax(derezFreq/overallscale,0.0001),1.0);
int bezFreqFraction = (int)(1.0/derezFreq);
double bezFreqTrim = (double)bezFreqFraction/(bezFreqFraction+1.0);
derezFreq = 1.0 / bezFreqFraction;
bezFreqTrim = 1.0-(derezFreq*bezFreqTrim);
//the revision more accurately connects the bezier curves
double wider = D*2.0;
double wet = E;
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;
bez[bez_cycle] += derez;
bez[bez_SampL] += (inputSampleL*attenuate*derez);
bez[bez_SampR] += (inputSampleR*attenuate*derez);
if (bez[bez_cycle] > 1.0) { //hit the end point and we do a reverb sample
bez[bez_cycle] = 0.0;
double mainSampleL = bez[bez_SampL];
double dualmonoSampleL = bez[bez_SampR];
//workaround involves keeping the cross-matrix system,
//but for initial layering, each side gets each version
//making blends never quite line up as exactly the same.
//left verbs
a4AL[c4AL] = mainSampleL + (f4DR * reg4n);
a4BL[c4BL] = mainSampleL + (f4HR * reg4n);
a4CL[c4CL] = mainSampleL + (f4LR * reg4n);
a4DL[c4DL] = mainSampleL + (f4PR * reg4n);
b4AL[c4AL] = dualmonoSampleL + (g4AL * reg4n);
b4BL[c4BL] = dualmonoSampleL + (g4BL * reg4n);
b4CL[c4CL] = dualmonoSampleL + (g4CL * reg4n);
b4DL[c4DL] = dualmonoSampleL + (g4DL * reg4n);
c4AL++; if (c4AL < 0 || c4AL > d4A) c4AL = 0;
c4BL++; if (c4BL < 0 || c4BL > d4B) c4BL = 0;
c4CL++; if (c4CL < 0 || c4CL > d4C) c4CL = 0;
c4DL++; if (c4DL < 0 || c4DL > d4D) c4DL = 0;
double hA = a4AL[c4AL-((c4AL > d4A)?d4A+1:0)];
double hB = a4BL[c4BL-((c4BL > d4B)?d4B+1:0)];
double hC = a4CL[c4CL-((c4CL > d4C)?d4C+1:0)];
double hD = a4DL[c4DL-((c4DL > d4D)?d4D+1:0)];
a4EL[c4EL] = hA - (hB + hC + hD);
a4FL[c4FL] = hB - (hA + hC + hD);
a4GL[c4GL] = hC - (hA + hB + hD);
a4HL[c4HL] = hD - (hA + hB + hC);
hA = b4AL[c4AL-((c4AL > d4A)?d4A+1:0)];
hB = b4BL[c4BL-((c4BL > d4B)?d4B+1:0)];
hC = b4CL[c4CL-((c4CL > d4C)?d4C+1:0)];
hD = b4DL[c4DL-((c4DL > d4D)?d4D+1:0)];
b4EL[c4EL] = hA - (hB + hC + hD);
b4FL[c4FL] = hB - (hA + hC + hD);
b4GL[c4GL] = hC - (hA + hB + hD);
b4HL[c4HL] = hD - (hA + hB + hC);
c4EL++; if (c4EL < 0 || c4EL > d4E) c4EL = 0;
c4FL++; if (c4FL < 0 || c4FL > d4F) c4FL = 0;
c4GL++; if (c4GL < 0 || c4GL > d4G) c4GL = 0;
c4HL++; if (c4HL < 0 || c4HL > d4H) c4HL = 0;
hA = a4EL[c4EL-((c4EL > d4E)?d4E+1:0)];
hB = a4FL[c4FL-((c4FL > d4F)?d4F+1:0)];
hC = a4GL[c4GL-((c4GL > d4G)?d4G+1:0)];
hD = a4HL[c4HL-((c4HL > d4H)?d4H+1:0)];
a4IL[c4IL] = hA - (hB + hC + hD);
a4JL[c4JL] = hB - (hA + hC + hD);
a4KL[c4KL] = hC - (hA + hB + hD);
a4LL[c4LL] = hD - (hA + hB + hC);
hA = b4EL[c4EL-((c4EL > d4E)?d4E+1:0)];
hB = b4FL[c4FL-((c4FL > d4F)?d4F+1:0)];
hC = b4GL[c4GL-((c4GL > d4G)?d4G+1:0)];
hD = b4HL[c4HL-((c4HL > d4H)?d4H+1:0)];
b4IL[c4IL] = hA - (hB + hC + hD);
b4JL[c4JL] = hB - (hA + hC + hD);
b4KL[c4KL] = hC - (hA + hB + hD);
b4LL[c4LL] = hD - (hA + hB + hC);
c4IL++; if (c4IL < 0 || c4IL > d4I) c4IL = 0;
c4JL++; if (c4JL < 0 || c4JL > d4J) c4JL = 0;
c4KL++; if (c4KL < 0 || c4KL > d4K) c4KL = 0;
c4LL++; if (c4LL < 0 || c4LL > d4L) c4LL = 0;
hA = a4IL[c4IL-((c4IL > d4I)?d4I+1:0)];
hB = a4JL[c4JL-((c4JL > d4J)?d4J+1:0)];
hC = a4KL[c4KL-((c4KL > d4K)?d4K+1:0)];
hD = a4LL[c4LL-((c4LL > d4L)?d4L+1:0)];
a4ML[c4ML] = hA - (hB + hC + hD);
a4NL[c4NL] = hB - (hA + hC + hD);
a4OL[c4OL] = hC - (hA + hB + hD);
a4PL[c4PL] = hD - (hA + hB + hC);
hA = b4IL[c4IL-((c4IL > d4I)?d4I+1:0)];
hB = b4JL[c4JL-((c4JL > d4J)?d4J+1:0)];
hC = b4KL[c4KL-((c4KL > d4K)?d4K+1:0)];
hD = b4LL[c4LL-((c4LL > d4L)?d4L+1:0)];
b4ML[c4ML] = hA - (hB + hC + hD);
b4NL[c4NL] = hB - (hA + hC + hD);
b4OL[c4OL] = hC - (hA + hB + hD);
b4PL[c4PL] = hD - (hA + hB + hC);
c4ML++; if (c4ML < 0 || c4ML > d4M) c4ML = 0;
c4NL++; if (c4NL < 0 || c4NL > d4N) c4NL = 0;
c4OL++; if (c4OL < 0 || c4OL > d4O) c4OL = 0;
c4PL++; if (c4PL < 0 || c4PL > d4P) c4PL = 0;
hA = a4ML[c4ML-((c4ML > d4M)?d4M+1:0)];
hB = a4NL[c4NL-((c4NL > d4N)?d4N+1:0)];
hC = a4OL[c4OL-((c4OL > d4O)?d4O+1:0)];
hD = a4PL[c4PL-((c4PL > d4P)?d4P+1:0)];
f4AL = hA - (hB + hC + hD);
f4BL = hB - (hA + hC + hD);
f4CL = hC - (hA + hB + hD);
f4DL = hD - (hA + hB + hC);//not actually crosschannel yet
mainSampleL = (hA + hB + hC + hD)*0.125;
hA = b4ML[c4ML-((c4ML > d4M)?d4M+1:0)];
hB = b4NL[c4NL-((c4NL > d4N)?d4N+1:0)];
hC = b4OL[c4OL-((c4OL > d4O)?d4O+1:0)];
hD = b4PL[c4PL-((c4PL > d4P)?d4P+1:0)];
g4AL = hA - (hB + hC + hD);
g4BL = hB - (hA + hC + hD);
g4CL = hC - (hA + hB + hD);
g4DL = hD - (hA + hB + hC);
dualmonoSampleL = (hA + hB + hC + hD)*0.125;
double mainSampleR = bez[bez_SampR]; //begin primary reverb
double dualmonoSampleR = bez[bez_SampL];
//right verbs
a4DR[c4DR] = mainSampleR + (f4AL * reg4n);
a4HR[c4HR] = mainSampleR + (f4BL * reg4n);
a4LR[c4LR] = mainSampleR + (f4CL * reg4n);
a4PR[c4PR] = mainSampleR + (f4DL * reg4n);
b4DR[c4DR] = dualmonoSampleR + (g4DR * reg4n);
b4HR[c4HR] = dualmonoSampleR + (g4HR * reg4n);
b4LR[c4LR] = dualmonoSampleR + (g4LR * reg4n);
b4PR[c4PR] = dualmonoSampleR + (g4PR * reg4n);
c4DR++; if (c4DR < 0 || c4DR > d4D) c4DR = 0;
c4HR++; if (c4HR < 0 || c4HR > d4H) c4HR = 0;
c4LR++; if (c4LR < 0 || c4LR > d4L) c4LR = 0;
c4PR++; if (c4PR < 0 || c4PR > d4P) c4PR = 0;
hA = a4DR[c4DR-((c4DR > d4D)?d4D+1:0)];
hB = a4HR[c4HR-((c4HR > d4H)?d4H+1:0)];
hC = a4LR[c4LR-((c4LR > d4L)?d4L+1:0)];
hD = a4PR[c4PR-((c4PR > d4P)?d4P+1:0)];
a4CR[c4CR] = hA - (hB + hC + hD);
a4GR[c4GR] = hB - (hA + hC + hD);
a4KR[c4KR] = hC - (hA + hB + hD);
a4OR[c4OR] = hD - (hA + hB + hC);
hA = b4DR[c4DR-((c4DR > d4D)?d4D+1:0)];
hB = b4HR[c4HR-((c4HR > d4H)?d4H+1:0)];
hC = b4LR[c4LR-((c4LR > d4L)?d4L+1:0)];
hD = b4PR[c4PR-((c4PR > d4P)?d4P+1:0)];
b4CR[c4CR] = hA - (hB + hC + hD);
b4GR[c4GR] = hB - (hA + hC + hD);
b4KR[c4KR] = hC - (hA + hB + hD);
b4OR[c4OR] = hD - (hA + hB + hC);
c4CR++; if (c4CR < 0 || c4CR > d4C) c4CR = 0;
c4GR++; if (c4GR < 0 || c4GR > d4G) c4GR = 0;
c4KR++; if (c4KR < 0 || c4KR > d4K) c4KR = 0;
c4OR++; if (c4OR < 0 || c4OR > d4O) c4OR = 0;
hA = a4CR[c4CR-((c4CR > d4C)?d4C+1:0)];
hB = a4GR[c4GR-((c4GR > d4G)?d4G+1:0)];
hC = a4KR[c4KR-((c4KR > d4K)?d4K+1:0)];
hD = a4OR[c4OR-((c4OR > d4O)?d4O+1:0)];
a4BR[c4BR] = hA - (hB + hC + hD);
a4FR[c4FR] = hB - (hA + hC + hD);
a4JR[c4JR] = hC - (hA + hB + hD);
a4NR[c4NR] = hD - (hA + hB + hC);
hA = b4CR[c4CR-((c4CR > d4C)?d4C+1:0)];
hB = b4GR[c4GR-((c4GR > d4G)?d4G+1:0)];
hC = b4KR[c4KR-((c4KR > d4K)?d4K+1:0)];
hD = b4OR[c4OR-((c4OR > d4O)?d4O+1:0)];
b4BR[c4BR] = hA - (hB + hC + hD);
b4FR[c4FR] = hB - (hA + hC + hD);
b4JR[c4JR] = hC - (hA + hB + hD);
b4NR[c4NR] = hD - (hA + hB + hC);
c4BR++; if (c4BR < 0 || c4BR > d4B) c4BR = 0;
c4FR++; if (c4FR < 0 || c4FR > d4F) c4FR = 0;
c4JR++; if (c4JR < 0 || c4JR > d4J) c4JR = 0;
c4NR++; if (c4NR < 0 || c4NR > d4N) c4NR = 0;
hA = a4BR[c4BR-((c4BR > d4B)?d4B+1:0)];
hB = a4FR[c4FR-((c4FR > d4F)?d4F+1:0)];
hC = a4JR[c4JR-((c4JR > d4J)?d4J+1:0)];
hD = a4NR[c4NR-((c4NR > d4N)?d4N+1:0)];
a4AR[c4AR] = hA - (hB + hC + hD);
a4ER[c4ER] = hB - (hA + hC + hD);
a4IR[c4IR] = hC - (hA + hB + hD);
a4MR[c4MR] = hD - (hA + hB + hC);
hA = b4BR[c4BR-((c4BR > d4B)?d4B+1:0)];
hB = b4FR[c4FR-((c4FR > d4F)?d4F+1:0)];
hC = b4JR[c4JR-((c4JR > d4J)?d4J+1:0)];
hD = b4NR[c4NR-((c4NR > d4N)?d4N+1:0)];
b4AR[c4AR] = hA - (hB + hC + hD);
b4ER[c4ER] = hB - (hA + hC + hD);
b4IR[c4IR] = hC - (hA + hB + hD);
b4MR[c4MR] = hD - (hA + hB + hC);
c4AR++; if (c4AR < 0 || c4AR > d4A) c4AR = 0;
c4ER++; if (c4ER < 0 || c4ER > d4E) c4ER = 0;
c4IR++; if (c4IR < 0 || c4IR > d4I) c4IR = 0;
c4MR++; if (c4MR < 0 || c4MR > d4M) c4MR = 0;
hA = a4AR[c4AR-((c4AR > d4A)?d4A+1:0)];
hB = a4ER[c4ER-((c4ER > d4E)?d4E+1:0)];
hC = a4IR[c4IR-((c4IR > d4I)?d4I+1:0)];
hD = a4MR[c4MR-((c4MR > d4M)?d4M+1:0)];
f4DR = hA - (hB + hC + hD);
f4HR = hB - (hA + hC + hD);
f4LR = hC - (hA + hB + hD);
f4PR = hD - (hA + hB + hC);
mainSampleR = (hA + hB + hC + hD)*0.125;
hA = b4AR[c4AR-((c4AR > d4A)?d4A+1:0)];
hB = b4ER[c4ER-((c4ER > d4E)?d4E+1:0)];
hC = b4IR[c4IR-((c4IR > d4I)?d4I+1:0)];
hD = b4MR[c4MR-((c4MR > d4M)?d4M+1:0)];
g4DR = hA - (hB + hC + hD);
g4HR = hB - (hA + hC + hD);
g4LR = hC - (hA + hB + hD);
g4PR = hD - (hA + hB + hC);
dualmonoSampleR = (hA + hB + hC + hD)*0.125;
//dual mono version is wider = 1.0 at the center
//with mainsample 0.0 and 2.0 (only at the edges)
//with mainsample out of phase when over 1.0
//couldn't re-do the arrays perfectly, so instead
//we keep exactly the same cross-matrix,
//but we flip the sides we're using for initial reverb.
//then, dualmono remains totally dualmono, and blend a bit in for wideness.
if (wider < 1.0) {
inputSampleL = (dualmonoSampleR*wider) + (mainSampleL*(1.0-wider));
inputSampleR = (dualmonoSampleL*wider) + (mainSampleR*(1.0-wider));
} else {
inputSampleL = (dualmonoSampleR*(2.0-wider)) + (mainSampleL*(wider-1.0));
inputSampleR = (dualmonoSampleL*(2.0-wider)) + (-mainSampleR*(wider-1.0));
}
inputSampleL = fmin(fmax(inputSampleL,-2.032610446872596),2.032610446872596);
long double X = inputSampleL * inputSampleL;
long double temp = inputSampleL * X;
inputSampleL -= (temp*0.125); temp *= X;
inputSampleL += (temp*0.0078125); temp *= X;
inputSampleL -= (temp*0.000244140625); temp *= X;
inputSampleL += (temp*0.000003814697265625); temp *= X;
inputSampleL -= (temp*0.0000000298023223876953125); temp *= X;
//purestsaturation: sine, except all the corrections
//retain mantissa of a long double increasing power function
inputSampleR = fmin(fmax(inputSampleR,-2.032610446872596),2.032610446872596);
X = inputSampleR * inputSampleR;
temp = inputSampleR * X;
inputSampleR -= (temp*0.125); temp *= X;
inputSampleR += (temp*0.0078125); temp *= X;
inputSampleR -= (temp*0.000244140625); temp *= X;
inputSampleR += (temp*0.000003814697265625); temp *= X;
inputSampleR -= (temp*0.0000000298023223876953125); temp *= X;
//purestsaturation: sine, except all the corrections
//retain mantissa of a long double increasing power function
bez[bez_CL] = bez[bez_BL];
bez[bez_BL] = bez[bez_AL];
bez[bez_AL] = inputSampleL;
bez[bez_SampL] = 0.0;
bez[bez_CR] = bez[bez_BR];
bez[bez_BR] = bez[bez_AR];
bez[bez_AR] = inputSampleR;
bez[bez_SampR] = 0.0;
}
double X = bez[bez_cycle]*bezTrim;
double CBL = (bez[bez_CL]*(1.0-X))+(bez[bez_BL]*X);
double CBR = (bez[bez_CR]*(1.0-X))+(bez[bez_BR]*X);
double BAL = (bez[bez_BL]*(1.0-X))+(bez[bez_AL]*X);
double BAR = (bez[bez_BR]*(1.0-X))+(bez[bez_AR]*X);
inputSampleL = (bez[bez_BL]+(CBL*(1.0-X))+(BAL*X))*-0.25;
inputSampleR = (bez[bez_BR]+(CBR*(1.0-X))+(BAR*X))*-0.25;
bezF[bez_cycle] += derezFreq;
bezF[bez_SampL] += (inputSampleL * derezFreq);
bezF[bez_SampR] += (inputSampleR * derezFreq);
if (bezF[bez_cycle] > 1.0) { //hit the end point and we do a filter sample
bezF[bez_cycle] = 0.0;
bezF[bez_CL] = bezF[bez_BL];
bezF[bez_BL] = bezF[bez_AL];
bezF[bez_AL] = bezF[bez_SampL];
bezF[bez_SampL] = 0.0;
bezF[bez_CR] = bezF[bez_BR];
bezF[bez_BR] = bezF[bez_AR];
bezF[bez_AR] = bezF[bez_SampR];
bezF[bez_SampR] = 0.0;
}
X = bezF[bez_cycle]*bezFreqTrim;
double CBLfreq = (bezF[bez_CL]*(1.0-X))+(bezF[bez_BL]*X);
double BALfreq = (bezF[bez_BL]*(1.0-X))+(bezF[bez_AL]*X);
inputSampleL = (bezF[bez_BL]+(CBLfreq*(1.0-X))+(BALfreq*X))*0.5;
double CBRfreq = (bezF[bez_CR]*(1.0-X))+(bezF[bez_BR]*X);
double BARfreq = (bezF[bez_BR]*(1.0-X))+(bezF[bez_AR]*X);
inputSampleR = (bezF[bez_BR]+(CBRfreq*(1.0-X))+(BARfreq*X))*0.5;
//filtering the reverb separately, after making it
inputSampleL = (inputSampleL * wet)+(drySampleL * (1.0-wet));
inputSampleR = (inputSampleR * wet)+(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++;
}
}
Reference in a new issue View git blame Copy permalink