initial commit
This commit is contained in:
Christopher Herb
677
filter/aw_eq.h
Normal file
677
filter/aw_eq.h
Normal file
@@ -0,0 +1,677 @@
|
||||
#pragma once
|
||||
#include <cstdlib>
|
||||
#include <stdint.h>
|
||||
|
||||
namespace trnr::lib::filter {
|
||||
// 3 band equalizer with high/lowpass filters based on EQ by Chris Johnson.
|
||||
class aw_eq {
|
||||
public:
|
||||
aw_eq() {
|
||||
samplerate = 44100;
|
||||
|
||||
A = 0.5; //Treble -12 to 12
|
||||
B = 0.5; //Mid -12 to 12
|
||||
C = 0.5; //Bass -12 to 12
|
||||
D = 1.0; //Lowpass 16.0K log 1 to 16 defaulting to 16K
|
||||
E = 0.4; //TrebFrq 6.0 log 1 to 16 defaulting to 6K
|
||||
F = 0.4; //BassFrq 100.0 log 30 to 1600 defaulting to 100 hz
|
||||
G = 0.0; //Hipass 30.0 log 30 to 1600 defaulting to 30
|
||||
H = 0.5; //OutGain -18 to 18
|
||||
|
||||
lastSampleL = 0.0;
|
||||
last2SampleL = 0.0;
|
||||
lastSampleR = 0.0;
|
||||
last2SampleR = 0.0;
|
||||
|
||||
iirHighSampleLA = 0.0;
|
||||
iirHighSampleLB = 0.0;
|
||||
iirHighSampleLC = 0.0;
|
||||
iirHighSampleLD = 0.0;
|
||||
iirHighSampleLE = 0.0;
|
||||
iirLowSampleLA = 0.0;
|
||||
iirLowSampleLB = 0.0;
|
||||
iirLowSampleLC = 0.0;
|
||||
iirLowSampleLD = 0.0;
|
||||
iirLowSampleLE = 0.0;
|
||||
iirHighSampleL = 0.0;
|
||||
iirLowSampleL = 0.0;
|
||||
|
||||
iirHighSampleRA = 0.0;
|
||||
iirHighSampleRB = 0.0;
|
||||
iirHighSampleRC = 0.0;
|
||||
iirHighSampleRD = 0.0;
|
||||
iirHighSampleRE = 0.0;
|
||||
iirLowSampleRA = 0.0;
|
||||
iirLowSampleRB = 0.0;
|
||||
iirLowSampleRC = 0.0;
|
||||
iirLowSampleRD = 0.0;
|
||||
iirLowSampleRE = 0.0;
|
||||
iirHighSampleR = 0.0;
|
||||
iirLowSampleR = 0.0;
|
||||
|
||||
tripletLA = 0.0;
|
||||
tripletLB = 0.0;
|
||||
tripletLC = 0.0;
|
||||
tripletFactorL = 0.0;
|
||||
|
||||
tripletRA = 0.0;
|
||||
tripletRB = 0.0;
|
||||
tripletRC = 0.0;
|
||||
tripletFactorR = 0.0;
|
||||
|
||||
lowpassSampleLAA = 0.0;
|
||||
lowpassSampleLAB = 0.0;
|
||||
lowpassSampleLBA = 0.0;
|
||||
lowpassSampleLBB = 0.0;
|
||||
lowpassSampleLCA = 0.0;
|
||||
lowpassSampleLCB = 0.0;
|
||||
lowpassSampleLDA = 0.0;
|
||||
lowpassSampleLDB = 0.0;
|
||||
lowpassSampleLE = 0.0;
|
||||
lowpassSampleLF = 0.0;
|
||||
lowpassSampleLG = 0.0;
|
||||
|
||||
lowpassSampleRAA = 0.0;
|
||||
lowpassSampleRAB = 0.0;
|
||||
lowpassSampleRBA = 0.0;
|
||||
lowpassSampleRBB = 0.0;
|
||||
lowpassSampleRCA = 0.0;
|
||||
lowpassSampleRCB = 0.0;
|
||||
lowpassSampleRDA = 0.0;
|
||||
lowpassSampleRDB = 0.0;
|
||||
lowpassSampleRE = 0.0;
|
||||
lowpassSampleRF = 0.0;
|
||||
lowpassSampleRG = 0.0;
|
||||
|
||||
highpassSampleLAA = 0.0;
|
||||
highpassSampleLAB = 0.0;
|
||||
highpassSampleLBA = 0.0;
|
||||
highpassSampleLBB = 0.0;
|
||||
highpassSampleLCA = 0.0;
|
||||
highpassSampleLCB = 0.0;
|
||||
highpassSampleLDA = 0.0;
|
||||
highpassSampleLDB = 0.0;
|
||||
highpassSampleLE = 0.0;
|
||||
highpassSampleLF = 0.0;
|
||||
|
||||
highpassSampleRAA = 0.0;
|
||||
highpassSampleRAB = 0.0;
|
||||
highpassSampleRBA = 0.0;
|
||||
highpassSampleRBB = 0.0;
|
||||
highpassSampleRCA = 0.0;
|
||||
highpassSampleRCB = 0.0;
|
||||
highpassSampleRDA = 0.0;
|
||||
highpassSampleRDB = 0.0;
|
||||
highpassSampleRE = 0.0;
|
||||
highpassSampleRF = 0.0;
|
||||
|
||||
flip = false;
|
||||
flipthree = 0;
|
||||
|
||||
fpdL = 1.0; while (fpdL < 16386) fpdL = rand()*UINT32_MAX;
|
||||
fpdR = 1.0; while (fpdR < 16386) fpdR = rand()*UINT32_MAX;
|
||||
//this is reset: values being initialized only once. Startup values, whatever they are.
|
||||
}
|
||||
|
||||
void set_treble(double value) {
|
||||
A = clamp(value);
|
||||
}
|
||||
|
||||
void set_mid(double value) {
|
||||
B = clamp(value);
|
||||
}
|
||||
|
||||
void set_bass(double value) {
|
||||
C = clamp(value);
|
||||
}
|
||||
|
||||
void set_lowpass(double value) {
|
||||
D = clamp(value);
|
||||
}
|
||||
|
||||
void set_treble_frq(double value) {
|
||||
E = clamp(value);
|
||||
}
|
||||
|
||||
void set_bass_frq(double value) {
|
||||
F = clamp(value);
|
||||
}
|
||||
|
||||
void set_hipass(double value) {
|
||||
G = clamp(value);
|
||||
}
|
||||
|
||||
void set_out_gain(double value) {
|
||||
H = clamp(value);
|
||||
}
|
||||
|
||||
void set_samplerate(double _samplerate) {
|
||||
samplerate = _samplerate;
|
||||
}
|
||||
|
||||
void process_block(double **inputs, double **outputs, long sampleframes) {
|
||||
|
||||
double* in1 = inputs[0];
|
||||
double* in2 = inputs[1];
|
||||
double* out1 = outputs[0];
|
||||
double* out2 = outputs[1];
|
||||
|
||||
double overallscale = 1.0;
|
||||
overallscale /= 44100.0;
|
||||
double compscale = overallscale;
|
||||
overallscale = samplerate;
|
||||
compscale = compscale * overallscale;
|
||||
//compscale is the one that's 1 or something like 2.2 for 96K rates
|
||||
|
||||
double inputSampleL;
|
||||
double inputSampleR;
|
||||
|
||||
double highSampleL = 0.0;
|
||||
double midSampleL = 0.0;
|
||||
double bassSampleL = 0.0;
|
||||
|
||||
double highSampleR = 0.0;
|
||||
double midSampleR = 0.0;
|
||||
double bassSampleR = 0.0;
|
||||
|
||||
double densityA = (A*12.0)-6.0;
|
||||
double densityB = (B*12.0)-6.0;
|
||||
double densityC = (C*12.0)-6.0;
|
||||
bool engageEQ = true;
|
||||
if ( (0.0 == densityA) && (0.0 == densityB) && (0.0 == densityC) ) engageEQ = false;
|
||||
|
||||
densityA = pow(10.0,densityA/20.0)-1.0;
|
||||
densityB = pow(10.0,densityB/20.0)-1.0;
|
||||
densityC = pow(10.0,densityC/20.0)-1.0;
|
||||
//convert to 0 to X multiplier with 1.0 being O db
|
||||
//minus one gives nearly -1 to ? (should top out at 1)
|
||||
//calibrate so that X db roughly equals X db with maximum topping out at 1 internally
|
||||
|
||||
double tripletIntensity = -densityA;
|
||||
|
||||
double iirAmountC = (((D*D*15.0)+1.0)*0.0188) + 0.7;
|
||||
if (iirAmountC > 1.0) iirAmountC = 1.0;
|
||||
bool engageLowpass = false;
|
||||
if (((D*D*15.0)+1.0) < 15.99) engageLowpass = true;
|
||||
|
||||
double iirAmountA = (((E*E*15.0)+1.0)*1000)/overallscale;
|
||||
double iirAmountB = (((F*F*1570.0)+30.0)*10)/overallscale;
|
||||
double iirAmountD = (((G*G*1570.0)+30.0)*1.0)/overallscale;
|
||||
bool engageHighpass = false;
|
||||
if (((G*G*1570.0)+30.0) > 30.01) engageHighpass = true;
|
||||
//bypass the highpass and lowpass if set to extremes
|
||||
double bridgerectifier;
|
||||
double outA = fabs(densityA);
|
||||
double outB = fabs(densityB);
|
||||
double outC = fabs(densityC);
|
||||
//end EQ
|
||||
double outputgain = pow(10.0,((H*36.0)-18.0)/20.0);
|
||||
|
||||
while (--sampleframes >= 0)
|
||||
{
|
||||
inputSampleL = *in1;
|
||||
inputSampleR = *in2;
|
||||
if (fabs(inputSampleL)<1.18e-23) inputSampleL = fpdL * 1.18e-17;
|
||||
if (fabs(inputSampleR)<1.18e-23) inputSampleR = fpdR * 1.18e-17;
|
||||
|
||||
last2SampleL = lastSampleL;
|
||||
lastSampleL = inputSampleL;
|
||||
|
||||
last2SampleR = lastSampleR;
|
||||
lastSampleR = inputSampleR;
|
||||
|
||||
flip = !flip;
|
||||
flipthree++;
|
||||
if (flipthree < 1 || flipthree > 3) flipthree = 1;
|
||||
//counters
|
||||
|
||||
//begin highpass
|
||||
if (engageHighpass)
|
||||
{
|
||||
if (flip)
|
||||
{
|
||||
highpassSampleLAA = (highpassSampleLAA * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLAA;
|
||||
highpassSampleLBA = (highpassSampleLBA * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLBA;
|
||||
highpassSampleLCA = (highpassSampleLCA * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLCA;
|
||||
highpassSampleLDA = (highpassSampleLDA * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLDA;
|
||||
}
|
||||
else
|
||||
{
|
||||
highpassSampleLAB = (highpassSampleLAB * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLAB;
|
||||
highpassSampleLBB = (highpassSampleLBB * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLBB;
|
||||
highpassSampleLCB = (highpassSampleLCB * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLCB;
|
||||
highpassSampleLDB = (highpassSampleLDB * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLDB;
|
||||
}
|
||||
highpassSampleLE = (highpassSampleLE * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLE;
|
||||
highpassSampleLF = (highpassSampleLF * (1.0 - iirAmountD)) + (inputSampleL * iirAmountD);
|
||||
inputSampleL -= highpassSampleLF;
|
||||
|
||||
if (flip)
|
||||
{
|
||||
highpassSampleRAA = (highpassSampleRAA * (1.0 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRAA;
|
||||
highpassSampleRBA = (highpassSampleRBA * (1.0 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRBA;
|
||||
highpassSampleRCA = (highpassSampleRCA * (1.0 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRCA;
|
||||
highpassSampleRDA = (highpassSampleRDA * (1.0 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRDA;
|
||||
}
|
||||
else
|
||||
{
|
||||
highpassSampleRAB = (highpassSampleRAB * (1.0 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRAB;
|
||||
highpassSampleRBB = (highpassSampleRBB * (1.0 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRBB;
|
||||
highpassSampleRCB = (highpassSampleRCB * (1.0 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRCB;
|
||||
highpassSampleRDB = (highpassSampleRDB * (1.0 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRDB;
|
||||
}
|
||||
highpassSampleRE = (highpassSampleRE * (1 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRE;
|
||||
highpassSampleRF = (highpassSampleRF * (1 - iirAmountD)) + (inputSampleR * iirAmountD);
|
||||
inputSampleR -= highpassSampleRF;
|
||||
|
||||
}
|
||||
//end highpass
|
||||
|
||||
//begin EQ
|
||||
if (engageEQ)
|
||||
{
|
||||
switch (flipthree)
|
||||
{
|
||||
case 1:
|
||||
tripletFactorL = last2SampleL - inputSampleL;
|
||||
tripletLA += tripletFactorL;
|
||||
tripletLC -= tripletFactorL;
|
||||
tripletFactorL = tripletLA * tripletIntensity;
|
||||
iirHighSampleLC = (iirHighSampleLC * (1.0 - iirAmountA)) + (inputSampleL * iirAmountA);
|
||||
highSampleL = inputSampleL - iirHighSampleLC;
|
||||
iirLowSampleLC = (iirLowSampleLC * (1.0 - iirAmountB)) + (inputSampleL * iirAmountB);
|
||||
bassSampleL = iirLowSampleLC;
|
||||
|
||||
tripletFactorR = last2SampleR - inputSampleR;
|
||||
tripletRA += tripletFactorR;
|
||||
tripletRC -= tripletFactorR;
|
||||
tripletFactorR = tripletRA * tripletIntensity;
|
||||
iirHighSampleRC = (iirHighSampleRC * (1.0 - iirAmountA)) + (inputSampleR * iirAmountA);
|
||||
highSampleR = inputSampleR - iirHighSampleRC;
|
||||
iirLowSampleRC = (iirLowSampleRC * (1.0 - iirAmountB)) + (inputSampleR * iirAmountB);
|
||||
bassSampleR = iirLowSampleRC;
|
||||
break;
|
||||
case 2:
|
||||
tripletFactorL = last2SampleL - inputSampleL;
|
||||
tripletLB += tripletFactorL;
|
||||
tripletLA -= tripletFactorL;
|
||||
tripletFactorL = tripletLB * tripletIntensity;
|
||||
iirHighSampleLD = (iirHighSampleLD * (1.0 - iirAmountA)) + (inputSampleL * iirAmountA);
|
||||
highSampleL = inputSampleL - iirHighSampleLD;
|
||||
iirLowSampleLD = (iirLowSampleLD * (1.0 - iirAmountB)) + (inputSampleL * iirAmountB);
|
||||
bassSampleL = iirLowSampleLD;
|
||||
|
||||
tripletFactorR = last2SampleR - inputSampleR;
|
||||
tripletRB += tripletFactorR;
|
||||
tripletRA -= tripletFactorR;
|
||||
tripletFactorR = tripletRB * tripletIntensity;
|
||||
iirHighSampleRD = (iirHighSampleRD * (1.0 - iirAmountA)) + (inputSampleR * iirAmountA);
|
||||
highSampleR = inputSampleR - iirHighSampleRD;
|
||||
iirLowSampleRD = (iirLowSampleRD * (1.0 - iirAmountB)) + (inputSampleR * iirAmountB);
|
||||
bassSampleR = iirLowSampleRD;
|
||||
break;
|
||||
case 3:
|
||||
tripletFactorL = last2SampleL - inputSampleL;
|
||||
tripletLC += tripletFactorL;
|
||||
tripletLB -= tripletFactorL;
|
||||
tripletFactorL = tripletLC * tripletIntensity;
|
||||
iirHighSampleLE = (iirHighSampleLE * (1.0 - iirAmountA)) + (inputSampleL * iirAmountA);
|
||||
highSampleL = inputSampleL - iirHighSampleLE;
|
||||
iirLowSampleLE = (iirLowSampleLE * (1.0 - iirAmountB)) + (inputSampleL * iirAmountB);
|
||||
bassSampleL = iirLowSampleLE;
|
||||
|
||||
tripletFactorR = last2SampleR - inputSampleR;
|
||||
tripletRC += tripletFactorR;
|
||||
tripletRB -= tripletFactorR;
|
||||
tripletFactorR = tripletRC * tripletIntensity;
|
||||
iirHighSampleRE = (iirHighSampleRE * (1.0 - iirAmountA)) + (inputSampleR * iirAmountA);
|
||||
highSampleR = inputSampleR - iirHighSampleRE;
|
||||
iirLowSampleRE = (iirLowSampleRE * (1.0 - iirAmountB)) + (inputSampleR * iirAmountB);
|
||||
bassSampleR = iirLowSampleRE;
|
||||
break;
|
||||
}
|
||||
tripletLA /= 2.0;
|
||||
tripletLB /= 2.0;
|
||||
tripletLC /= 2.0;
|
||||
highSampleL = highSampleL + tripletFactorL;
|
||||
|
||||
tripletRA /= 2.0;
|
||||
tripletRB /= 2.0;
|
||||
tripletRC /= 2.0;
|
||||
highSampleR = highSampleR + tripletFactorR;
|
||||
|
||||
if (flip)
|
||||
{
|
||||
iirHighSampleLA = (iirHighSampleLA * (1.0 - iirAmountA)) + (highSampleL * iirAmountA);
|
||||
highSampleL -= iirHighSampleLA;
|
||||
iirLowSampleLA = (iirLowSampleLA * (1.0 - iirAmountB)) + (bassSampleL * iirAmountB);
|
||||
bassSampleL = iirLowSampleLA;
|
||||
|
||||
iirHighSampleRA = (iirHighSampleRA * (1.0 - iirAmountA)) + (highSampleR * iirAmountA);
|
||||
highSampleR -= iirHighSampleRA;
|
||||
iirLowSampleRA = (iirLowSampleRA * (1.0 - iirAmountB)) + (bassSampleR * iirAmountB);
|
||||
bassSampleR = iirLowSampleRA;
|
||||
}
|
||||
else
|
||||
{
|
||||
iirHighSampleLB = (iirHighSampleLB * (1.0 - iirAmountA)) + (highSampleL * iirAmountA);
|
||||
highSampleL -= iirHighSampleLB;
|
||||
iirLowSampleLB = (iirLowSampleLB * (1.0 - iirAmountB)) + (bassSampleL * iirAmountB);
|
||||
bassSampleL = iirLowSampleLB;
|
||||
|
||||
iirHighSampleRB = (iirHighSampleRB * (1.0 - iirAmountA)) + (highSampleR * iirAmountA);
|
||||
highSampleR -= iirHighSampleRB;
|
||||
iirLowSampleRB = (iirLowSampleRB * (1.0 - iirAmountB)) + (bassSampleR * iirAmountB);
|
||||
bassSampleR = iirLowSampleRB;
|
||||
}
|
||||
|
||||
iirHighSampleL = (iirHighSampleL * (1.0 - iirAmountA)) + (highSampleL * iirAmountA);
|
||||
highSampleL -= iirHighSampleL;
|
||||
iirLowSampleL = (iirLowSampleL * (1.0 - iirAmountB)) + (bassSampleL * iirAmountB);
|
||||
bassSampleL = iirLowSampleL;
|
||||
|
||||
iirHighSampleR = (iirHighSampleR * (1.0 - iirAmountA)) + (highSampleR * iirAmountA);
|
||||
highSampleR -= iirHighSampleR;
|
||||
iirLowSampleR = (iirLowSampleR * (1.0 - iirAmountB)) + (bassSampleR * iirAmountB);
|
||||
bassSampleR = iirLowSampleR;
|
||||
|
||||
midSampleL = (inputSampleL-bassSampleL)-highSampleL;
|
||||
midSampleR = (inputSampleR-bassSampleR)-highSampleR;
|
||||
|
||||
//drive section
|
||||
highSampleL *= (densityA+1.0);
|
||||
bridgerectifier = fabs(highSampleL)*1.57079633;
|
||||
if (bridgerectifier > 1.57079633) bridgerectifier = 1.57079633;
|
||||
//max value for sine function
|
||||
if (densityA > 0) bridgerectifier = sin(bridgerectifier);
|
||||
else bridgerectifier = 1-cos(bridgerectifier);
|
||||
//produce either boosted or starved version
|
||||
if (highSampleL > 0) highSampleL = (highSampleL*(1-outA))+(bridgerectifier*outA);
|
||||
else highSampleL = (highSampleL*(1-outA))-(bridgerectifier*outA);
|
||||
//blend according to densityA control
|
||||
|
||||
highSampleR *= (densityA+1.0);
|
||||
bridgerectifier = fabs(highSampleR)*1.57079633;
|
||||
if (bridgerectifier > 1.57079633) bridgerectifier = 1.57079633;
|
||||
//max value for sine function
|
||||
if (densityA > 0) bridgerectifier = sin(bridgerectifier);
|
||||
else bridgerectifier = 1-cos(bridgerectifier);
|
||||
//produce either boosted or starved version
|
||||
if (highSampleR > 0) highSampleR = (highSampleR*(1-outA))+(bridgerectifier*outA);
|
||||
else highSampleR = (highSampleR*(1-outA))-(bridgerectifier*outA);
|
||||
//blend according to densityA control
|
||||
|
||||
midSampleL *= (densityB+1.0);
|
||||
bridgerectifier = fabs(midSampleL)*1.57079633;
|
||||
if (bridgerectifier > 1.57079633) bridgerectifier = 1.57079633;
|
||||
//max value for sine function
|
||||
if (densityB > 0) bridgerectifier = sin(bridgerectifier);
|
||||
else bridgerectifier = 1-cos(bridgerectifier);
|
||||
//produce either boosted or starved version
|
||||
if (midSampleL > 0) midSampleL = (midSampleL*(1-outB))+(bridgerectifier*outB);
|
||||
else midSampleL = (midSampleL*(1-outB))-(bridgerectifier*outB);
|
||||
//blend according to densityB control
|
||||
|
||||
midSampleR *= (densityB+1.0);
|
||||
bridgerectifier = fabs(midSampleR)*1.57079633;
|
||||
if (bridgerectifier > 1.57079633) bridgerectifier = 1.57079633;
|
||||
//max value for sine function
|
||||
if (densityB > 0) bridgerectifier = sin(bridgerectifier);
|
||||
else bridgerectifier = 1-cos(bridgerectifier);
|
||||
//produce either boosted or starved version
|
||||
if (midSampleR > 0) midSampleR = (midSampleR*(1-outB))+(bridgerectifier*outB);
|
||||
else midSampleR = (midSampleR*(1-outB))-(bridgerectifier*outB);
|
||||
//blend according to densityB control
|
||||
|
||||
bassSampleL *= (densityC+1.0);
|
||||
bridgerectifier = fabs(bassSampleL)*1.57079633;
|
||||
if (bridgerectifier > 1.57079633) bridgerectifier = 1.57079633;
|
||||
//max value for sine function
|
||||
if (densityC > 0) bridgerectifier = sin(bridgerectifier);
|
||||
else bridgerectifier = 1-cos(bridgerectifier);
|
||||
//produce either boosted or starved version
|
||||
if (bassSampleL > 0) bassSampleL = (bassSampleL*(1-outC))+(bridgerectifier*outC);
|
||||
else bassSampleL = (bassSampleL*(1-outC))-(bridgerectifier*outC);
|
||||
//blend according to densityC control
|
||||
|
||||
bassSampleR *= (densityC+1.0);
|
||||
bridgerectifier = fabs(bassSampleR)*1.57079633;
|
||||
if (bridgerectifier > 1.57079633) bridgerectifier = 1.57079633;
|
||||
//max value for sine function
|
||||
if (densityC > 0) bridgerectifier = sin(bridgerectifier);
|
||||
else bridgerectifier = 1-cos(bridgerectifier);
|
||||
//produce either boosted or starved version
|
||||
if (bassSampleR > 0) bassSampleR = (bassSampleR*(1-outC))+(bridgerectifier*outC);
|
||||
else bassSampleR = (bassSampleR*(1-outC))-(bridgerectifier*outC);
|
||||
//blend according to densityC control
|
||||
|
||||
inputSampleL = midSampleL;
|
||||
inputSampleL += highSampleL;
|
||||
inputSampleL += bassSampleL;
|
||||
|
||||
inputSampleR = midSampleR;
|
||||
inputSampleR += highSampleR;
|
||||
inputSampleR += bassSampleR;
|
||||
}
|
||||
//end EQ
|
||||
|
||||
//EQ lowpass is after all processing like the compressor that might produce hash
|
||||
if (engageLowpass)
|
||||
{
|
||||
if (flip)
|
||||
{
|
||||
lowpassSampleLAA = (lowpassSampleLAA * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLAA;
|
||||
lowpassSampleLBA = (lowpassSampleLBA * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLBA;
|
||||
lowpassSampleLCA = (lowpassSampleLCA * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLCA;
|
||||
lowpassSampleLDA = (lowpassSampleLDA * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLDA;
|
||||
lowpassSampleLE = (lowpassSampleLE * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLE;
|
||||
|
||||
lowpassSampleRAA = (lowpassSampleRAA * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRAA;
|
||||
lowpassSampleRBA = (lowpassSampleRBA * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRBA;
|
||||
lowpassSampleRCA = (lowpassSampleRCA * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRCA;
|
||||
lowpassSampleRDA = (lowpassSampleRDA * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRDA;
|
||||
lowpassSampleRE = (lowpassSampleRE * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRE;
|
||||
}
|
||||
else
|
||||
{
|
||||
lowpassSampleLAB = (lowpassSampleLAB * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLAB;
|
||||
lowpassSampleLBB = (lowpassSampleLBB * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLBB;
|
||||
lowpassSampleLCB = (lowpassSampleLCB * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLCB;
|
||||
lowpassSampleLDB = (lowpassSampleLDB * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLDB;
|
||||
lowpassSampleLF = (lowpassSampleLF * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleL = lowpassSampleLF;
|
||||
|
||||
lowpassSampleRAB = (lowpassSampleRAB * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRAB;
|
||||
lowpassSampleRBB = (lowpassSampleRBB * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRBB;
|
||||
lowpassSampleRCB = (lowpassSampleRCB * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRCB;
|
||||
lowpassSampleRDB = (lowpassSampleRDB * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRDB;
|
||||
lowpassSampleRF = (lowpassSampleRF * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
inputSampleR = lowpassSampleRF;
|
||||
}
|
||||
lowpassSampleLG = (lowpassSampleLG * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
lowpassSampleRG = (lowpassSampleRG * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
|
||||
inputSampleL = (lowpassSampleLG * (1.0 - iirAmountC)) + (inputSampleL * iirAmountC);
|
||||
inputSampleR = (lowpassSampleRG * (1.0 - iirAmountC)) + (inputSampleR * iirAmountC);
|
||||
}
|
||||
|
||||
//built in output trim and dry/wet if desired
|
||||
if (outputgain != 1.0) {
|
||||
inputSampleL *= outputgain;
|
||||
inputSampleR *= outputgain;
|
||||
}
|
||||
|
||||
//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++;
|
||||
}
|
||||
}
|
||||
|
||||
private:
|
||||
double samplerate;
|
||||
|
||||
uint32_t fpdL;
|
||||
uint32_t fpdR;
|
||||
//default stuff
|
||||
|
||||
double lastSampleL;
|
||||
double last2SampleL;
|
||||
double lastSampleR;
|
||||
double last2SampleR;
|
||||
|
||||
//begin EQ
|
||||
double iirHighSampleLA;
|
||||
double iirHighSampleLB;
|
||||
double iirHighSampleLC;
|
||||
double iirHighSampleLD;
|
||||
double iirHighSampleLE;
|
||||
double iirLowSampleLA;
|
||||
double iirLowSampleLB;
|
||||
double iirLowSampleLC;
|
||||
double iirLowSampleLD;
|
||||
double iirLowSampleLE;
|
||||
double iirHighSampleL;
|
||||
double iirLowSampleL;
|
||||
|
||||
double iirHighSampleRA;
|
||||
double iirHighSampleRB;
|
||||
double iirHighSampleRC;
|
||||
double iirHighSampleRD;
|
||||
double iirHighSampleRE;
|
||||
double iirLowSampleRA;
|
||||
double iirLowSampleRB;
|
||||
double iirLowSampleRC;
|
||||
double iirLowSampleRD;
|
||||
double iirLowSampleRE;
|
||||
double iirHighSampleR;
|
||||
double iirLowSampleR;
|
||||
|
||||
double tripletLA;
|
||||
double tripletLB;
|
||||
double tripletLC;
|
||||
double tripletFactorL;
|
||||
|
||||
double tripletRA;
|
||||
double tripletRB;
|
||||
double tripletRC;
|
||||
double tripletFactorR;
|
||||
|
||||
double lowpassSampleLAA;
|
||||
double lowpassSampleLAB;
|
||||
double lowpassSampleLBA;
|
||||
double lowpassSampleLBB;
|
||||
double lowpassSampleLCA;
|
||||
double lowpassSampleLCB;
|
||||
double lowpassSampleLDA;
|
||||
double lowpassSampleLDB;
|
||||
double lowpassSampleLE;
|
||||
double lowpassSampleLF;
|
||||
double lowpassSampleLG;
|
||||
|
||||
double lowpassSampleRAA;
|
||||
double lowpassSampleRAB;
|
||||
double lowpassSampleRBA;
|
||||
double lowpassSampleRBB;
|
||||
double lowpassSampleRCA;
|
||||
double lowpassSampleRCB;
|
||||
double lowpassSampleRDA;
|
||||
double lowpassSampleRDB;
|
||||
double lowpassSampleRE;
|
||||
double lowpassSampleRF;
|
||||
double lowpassSampleRG;
|
||||
|
||||
double highpassSampleLAA;
|
||||
double highpassSampleLAB;
|
||||
double highpassSampleLBA;
|
||||
double highpassSampleLBB;
|
||||
double highpassSampleLCA;
|
||||
double highpassSampleLCB;
|
||||
double highpassSampleLDA;
|
||||
double highpassSampleLDB;
|
||||
double highpassSampleLE;
|
||||
double highpassSampleLF;
|
||||
|
||||
double highpassSampleRAA;
|
||||
double highpassSampleRAB;
|
||||
double highpassSampleRBA;
|
||||
double highpassSampleRBB;
|
||||
double highpassSampleRCA;
|
||||
double highpassSampleRCB;
|
||||
double highpassSampleRDA;
|
||||
double highpassSampleRDB;
|
||||
double highpassSampleRE;
|
||||
double highpassSampleRF;
|
||||
|
||||
bool flip;
|
||||
int flipthree;
|
||||
//end EQ
|
||||
|
||||
|
||||
float A;
|
||||
float B;
|
||||
float C;
|
||||
float D;
|
||||
float E;
|
||||
float F;
|
||||
float G;
|
||||
float H;
|
||||
|
||||
double clamp(double& value) {
|
||||
if (value > 1) {
|
||||
value = 1;
|
||||
} else if (value < 0) {
|
||||
value = 0;
|
||||
}
|
||||
return value;
|
||||
}
|
||||
};
|
||||
}
|
||||
Reference in New Issue
Block a user