airwindows/plugins/MacSignedVST/Cojones/source/CojonesProc.cpp
2022-11-21 09:20:21 -05:00

280 lines
8.1 KiB
C++
Executable file

/* ========================================
* Cojones - Cojones.h
* Copyright (c) 2016 airwindows, Airwindows uses the MIT license
* ======================================== */
#ifndef __Cojones_H
#include "Cojones.h"
#endif
void Cojones::processReplacing(float **inputs, float **outputs, VstInt32 sampleFrames)
{
float* in1 = inputs[0];
float* in2 = inputs[1];
float* out1 = outputs[0];
float* out2 = outputs[1];
double breathy = A*2.0;
double cojones = B*2.0;
double body = C*2.0;
double output = D;
double wet = E;
double averageL[5];
double averageR[5];
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;
//begin L
storedL[1] = storedL[0];
storedL[0] = inputSampleL;
diffL[5] = diffL[4];
diffL[4] = diffL[3];
diffL[3] = diffL[2];
diffL[2] = diffL[1];
diffL[1] = diffL[0];
diffL[0] = storedL[0] - storedL[1];
averageL[0] = diffL[0] + diffL[1];
averageL[1] = averageL[0] + diffL[2];
averageL[2] = averageL[1] + diffL[3];
averageL[3] = averageL[2] + diffL[4];
averageL[4] = averageL[3] + diffL[5];
averageL[0] /= 2.0;
averageL[1] /= 3.0;
averageL[2] /= 4.0;
averageL[3] /= 5.0;
averageL[4] /= 6.0;
double meanA = diffL[0];
double meanB = diffL[0];
if (fabs(averageL[4]) < fabs(meanB)) {meanA = meanB; meanB = averageL[4];}
if (fabs(averageL[3]) < fabs(meanB)) {meanA = meanB; meanB = averageL[3];}
if (fabs(averageL[2]) < fabs(meanB)) {meanA = meanB; meanB = averageL[2];}
if (fabs(averageL[1]) < fabs(meanB)) {meanA = meanB; meanB = averageL[1];}
if (fabs(averageL[0]) < fabs(meanB)) {meanA = meanB; meanB = averageL[0];}
double meanOut = ((meanA+meanB)/2.0);
storedL[0] = (storedL[1] + meanOut);
double outputSample = storedL[0]*body;
//presubtract cojones
outputSample += (((inputSampleL - storedL[0])-averageL[1])*cojones);
outputSample += (averageL[1]*breathy);
inputSampleL = outputSample;
//end L
//begin R
storedR[1] = storedR[0];
storedR[0] = inputSampleR;
diffR[5] = diffR[4];
diffR[4] = diffR[3];
diffR[3] = diffR[2];
diffR[2] = diffR[1];
diffR[1] = diffR[0];
diffR[0] = storedR[0] - storedR[1];
averageR[0] = diffR[0] + diffR[1];
averageR[1] = averageR[0] + diffR[2];
averageR[2] = averageR[1] + diffR[3];
averageR[3] = averageR[2] + diffR[4];
averageR[4] = averageR[3] + diffR[5];
averageR[0] /= 2.0;
averageR[1] /= 3.0;
averageR[2] /= 4.0;
averageR[3] /= 5.0;
averageR[4] /= 6.0;
meanA = diffR[0];
meanB = diffR[0];
if (fabs(averageR[4]) < fabs(meanB)) {meanA = meanB; meanB = averageR[4];}
if (fabs(averageR[3]) < fabs(meanB)) {meanA = meanB; meanB = averageR[3];}
if (fabs(averageR[2]) < fabs(meanB)) {meanA = meanB; meanB = averageR[2];}
if (fabs(averageR[1]) < fabs(meanB)) {meanA = meanB; meanB = averageR[1];}
if (fabs(averageR[0]) < fabs(meanB)) {meanA = meanB; meanB = averageR[0];}
meanOut = ((meanA+meanB)/2.0);
storedR[0] = (storedR[1] + meanOut);
outputSample = storedR[0]*body;
//presubtract cojones
outputSample += (((inputSampleR - storedR[0])-averageR[1])*cojones);
outputSample += (averageR[1]*breathy);
inputSampleR = outputSample;
//end R
if (output < 1.0) {
inputSampleL *= output;
inputSampleR *= output;
}
if (wet < 1.0) {
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 Cojones::processDoubleReplacing(double **inputs, double **outputs, VstInt32 sampleFrames)
{
double* in1 = inputs[0];
double* in2 = inputs[1];
double* out1 = outputs[0];
double* out2 = outputs[1];
double breathy = A*2.0;
double cojones = B*2.0;
double body = C*2.0;
double output = D;
double wet = E;
double averageL[5];
double averageR[5];
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;
//begin L
storedL[1] = storedL[0];
storedL[0] = inputSampleL;
diffL[5] = diffL[4];
diffL[4] = diffL[3];
diffL[3] = diffL[2];
diffL[2] = diffL[1];
diffL[1] = diffL[0];
diffL[0] = storedL[0] - storedL[1];
averageL[0] = diffL[0] + diffL[1];
averageL[1] = averageL[0] + diffL[2];
averageL[2] = averageL[1] + diffL[3];
averageL[3] = averageL[2] + diffL[4];
averageL[4] = averageL[3] + diffL[5];
averageL[0] /= 2.0;
averageL[1] /= 3.0;
averageL[2] /= 4.0;
averageL[3] /= 5.0;
averageL[4] /= 6.0;
double meanA = diffL[0];
double meanB = diffL[0];
if (fabs(averageL[4]) < fabs(meanB)) {meanA = meanB; meanB = averageL[4];}
if (fabs(averageL[3]) < fabs(meanB)) {meanA = meanB; meanB = averageL[3];}
if (fabs(averageL[2]) < fabs(meanB)) {meanA = meanB; meanB = averageL[2];}
if (fabs(averageL[1]) < fabs(meanB)) {meanA = meanB; meanB = averageL[1];}
if (fabs(averageL[0]) < fabs(meanB)) {meanA = meanB; meanB = averageL[0];}
double meanOut = ((meanA+meanB)/2.0);
storedL[0] = (storedL[1] + meanOut);
double outputSample = storedL[0]*body;
//presubtract cojones
outputSample += (((inputSampleL - storedL[0])-averageL[1])*cojones);
outputSample += (averageL[1]*breathy);
inputSampleL = outputSample;
//end L
//begin R
storedR[1] = storedR[0];
storedR[0] = inputSampleR;
diffR[5] = diffR[4];
diffR[4] = diffR[3];
diffR[3] = diffR[2];
diffR[2] = diffR[1];
diffR[1] = diffR[0];
diffR[0] = storedR[0] - storedR[1];
averageR[0] = diffR[0] + diffR[1];
averageR[1] = averageR[0] + diffR[2];
averageR[2] = averageR[1] + diffR[3];
averageR[3] = averageR[2] + diffR[4];
averageR[4] = averageR[3] + diffR[5];
averageR[0] /= 2.0;
averageR[1] /= 3.0;
averageR[2] /= 4.0;
averageR[3] /= 5.0;
averageR[4] /= 6.0;
meanA = diffR[0];
meanB = diffR[0];
if (fabs(averageR[4]) < fabs(meanB)) {meanA = meanB; meanB = averageR[4];}
if (fabs(averageR[3]) < fabs(meanB)) {meanA = meanB; meanB = averageR[3];}
if (fabs(averageR[2]) < fabs(meanB)) {meanA = meanB; meanB = averageR[2];}
if (fabs(averageR[1]) < fabs(meanB)) {meanA = meanB; meanB = averageR[1];}
if (fabs(averageR[0]) < fabs(meanB)) {meanA = meanB; meanB = averageR[0];}
meanOut = ((meanA+meanB)/2.0);
storedR[0] = (storedR[1] + meanOut);
outputSample = storedR[0]*body;
//presubtract cojones
outputSample += (((inputSampleR - storedR[0])-averageR[1])*cojones);
outputSample += (averageR[1]*breathy);
inputSampleR = outputSample;
//end R
if (output < 1.0) {
inputSampleL *= output;
inputSampleR *= output;
}
if (wet < 1.0) {
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++;
}
}