diff options
Diffstat (limited to 'plugins/MacVST/Focus/source/FocusProc.cpp')
-rwxr-xr-x | plugins/MacVST/Focus/source/FocusProc.cpp | 284 |
1 files changed, 284 insertions, 0 deletions
diff --git a/plugins/MacVST/Focus/source/FocusProc.cpp b/plugins/MacVST/Focus/source/FocusProc.cpp new file mode 100755 index 0000000..3d9d8dc --- /dev/null +++ b/plugins/MacVST/Focus/source/FocusProc.cpp @@ -0,0 +1,284 @@ +/* ======================================== + * Focus - Focus.h + * Copyright (c) 2016 airwindows, All rights reserved + * ======================================== */ + +#ifndef __Focus_H +#include "Focus.h" +#endif + +void Focus::processReplacing(float **inputs, float **outputs, VstInt32 sampleFrames) +{ + float* in1 = inputs[0]; + float* in2 = inputs[1]; + float* out1 = outputs[0]; + float* out2 = outputs[1]; + + //[0] is frequency: 0.000001 to 0.499999 is near-zero to near-Nyquist + //[1] is resonance, 0.7071 is Butterworth. Also can't be zero + double boost = pow(10.0,(A*12.0)/20.0); + figureL[0] = figureR[0] = 3515.775/getSampleRate(); //fixed frequency, 3.515775k + figureL[1] = figureR[1] = pow(pow(B,3)*2,2)+0.0001; //resonance + int mode = (int) ( C * 4.999 ); + double output = D; + double wet = E; + + double K = tan(M_PI * figureR[0]); + double norm = 1.0 / (1.0 + K / figureR[1] + K * K); + figureL[2] = figureR[2] = K / figureR[1] * norm; + figureL[4] = figureR[4] = -figureR[2]; + figureL[5] = figureR[5] = 2.0 * (K * K - 1.0) * norm; + figureL[6] = figureR[6] = (1.0 - K / figureR[1] + K * K) * norm; + + while (--sampleFrames >= 0) + { + long double inputSampleL = *in1; + long double inputSampleR = *in2; + if (fabs(inputSampleL)<1.18e-37) inputSampleL = fpd * 1.18e-37; + if (fabs(inputSampleR)<1.18e-37) inputSampleR = fpd * 1.18e-37; + long double drySampleL = inputSampleL; + long double drySampleR = inputSampleR; + + inputSampleL = sin(inputSampleL); + inputSampleR = sin(inputSampleR); + //encode Console5: good cleanness + + long double tempSample = (inputSampleL * figureL[2]) + figureL[7]; + figureL[7] = -(tempSample * figureL[5]) + figureL[8]; + figureL[8] = (inputSampleL * figureL[4]) - (tempSample * figureL[6]); + inputSampleL = tempSample; + + tempSample = (inputSampleR * figureR[2]) + figureR[7]; + figureR[7] = -(tempSample * figureR[5]) + figureR[8]; + figureR[8] = (inputSampleR * figureR[4]) - (tempSample * figureR[6]); + inputSampleR = tempSample; + + 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); + //decode Console5 + + long double groundSampleL = drySampleL - inputSampleL; //set up UnBox + long double groundSampleR = drySampleR - inputSampleR; //set up UnBox + inputSampleL *= boost; //now, focussed area gets cranked before distort + inputSampleR *= boost; //now, focussed area gets cranked before distort + + switch (mode) + { + case 0: //Density + if (inputSampleL > 1.570796326794897) inputSampleL = 1.570796326794897; + if (inputSampleL < -1.570796326794897) inputSampleL = -1.570796326794897; + if (inputSampleR > 1.570796326794897) inputSampleR = 1.570796326794897; + if (inputSampleR < -1.570796326794897) inputSampleR = -1.570796326794897; + //clip to 1.570796326794897 to reach maximum output + inputSampleL = sin(inputSampleL); + inputSampleR = sin(inputSampleR); + break; + case 1: //Drive + 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; + inputSampleL -= (inputSampleL * (fabs(inputSampleL) * 0.6) * (fabs(inputSampleL) * 0.6)); + inputSampleR -= (inputSampleR * (fabs(inputSampleR) * 0.6) * (fabs(inputSampleR) * 0.6)); + inputSampleL *= 1.6; + inputSampleR *= 1.6; + break; + case 2: //Spiral + if (inputSampleL > 1.2533141373155) inputSampleL = 1.2533141373155; + if (inputSampleL < -1.2533141373155) inputSampleL = -1.2533141373155; + if (inputSampleR > 1.2533141373155) inputSampleR = 1.2533141373155; + if (inputSampleR < -1.2533141373155) inputSampleR = -1.2533141373155; + //clip to 1.2533141373155 to reach maximum output + inputSampleL = sin(inputSampleL * fabs(inputSampleL)) / ((inputSampleL == 0.0) ?1:fabs(inputSampleL)); + inputSampleR = sin(inputSampleR * fabs(inputSampleR)) / ((inputSampleR == 0.0) ?1:fabs(inputSampleR)); + break; + case 3: //Mojo + long double mojo; mojo = pow(fabs(inputSampleL),0.25); + if (mojo > 0.0) inputSampleL = (sin(inputSampleL * mojo * M_PI * 0.5) / mojo) * 0.987654321; + mojo = pow(fabs(inputSampleR),0.25); + if (mojo > 0.0) inputSampleR = (sin(inputSampleR * mojo * M_PI * 0.5) / mojo) * 0.987654321; + //mojo is the one that flattens WAAAAY out very softly before wavefolding + break; + case 4: //Dyno + long double dyno; dyno = pow(fabs(inputSampleL),4); + if (dyno > 0.0) inputSampleL = (sin(inputSampleL * dyno) / dyno) * 1.1654321; + dyno = pow(fabs(inputSampleR),4); + if (dyno > 0.0) inputSampleR = (sin(inputSampleR * dyno) / dyno) * 1.1654321; + //dyno is the one that tries to raise peak energy + break; + } + + if (output != 1.0) { + inputSampleL *= output; + inputSampleR *= output; + } + + inputSampleL += groundSampleL; //effectively UnBox + inputSampleR += groundSampleR; //effectively UnBox + + 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); + fpd ^= fpd << 13; fpd ^= fpd >> 17; fpd ^= fpd << 5; + inputSampleL += ((double(fpd)-uint32_t(0x7fffffff)) * 5.5e-36l * pow(2,expon+62)); + frexpf((float)inputSampleR, &expon); + fpd ^= fpd << 13; fpd ^= fpd >> 17; fpd ^= fpd << 5; + inputSampleR += ((double(fpd)-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 Focus::processDoubleReplacing(double **inputs, double **outputs, VstInt32 sampleFrames) +{ + double* in1 = inputs[0]; + double* in2 = inputs[1]; + double* out1 = outputs[0]; + double* out2 = outputs[1]; + + //[0] is frequency: 0.000001 to 0.499999 is near-zero to near-Nyquist + //[1] is resonance, 0.7071 is Butterworth. Also can't be zero + double boost = pow(10.0,(A*12.0)/20.0); + figureL[0] = figureR[0] = 3515.775/getSampleRate(); //fixed frequency, 3.515775k + figureL[1] = figureR[1] = pow(pow(B,3)*2,2)+0.0001; //resonance + int mode = (int) ( C * 4.999 ); + double output = D; + double wet = E; + + double K = tan(M_PI * figureR[0]); + double norm = 1.0 / (1.0 + K / figureR[1] + K * K); + figureL[2] = figureR[2] = K / figureR[1] * norm; + figureL[4] = figureR[4] = -figureR[2]; + figureL[5] = figureR[5] = 2.0 * (K * K - 1.0) * norm; + figureL[6] = figureR[6] = (1.0 - K / figureR[1] + K * K) * norm; + + while (--sampleFrames >= 0) + { + long double inputSampleL = *in1; + long double inputSampleR = *in2; + if (fabs(inputSampleL)<1.18e-43) inputSampleL = fpd * 1.18e-43; + if (fabs(inputSampleR)<1.18e-43) inputSampleR = fpd * 1.18e-43; + long double drySampleL = inputSampleL; + long double drySampleR = inputSampleR; + + inputSampleL = sin(inputSampleL); + inputSampleR = sin(inputSampleR); + //encode Console5: good cleanness + + long double tempSample = (inputSampleL * figureL[2]) + figureL[7]; + figureL[7] = -(tempSample * figureL[5]) + figureL[8]; + figureL[8] = (inputSampleL * figureL[4]) - (tempSample * figureL[6]); + inputSampleL = tempSample; + + tempSample = (inputSampleR * figureR[2]) + figureR[7]; + figureR[7] = -(tempSample * figureR[5]) + figureR[8]; + figureR[8] = (inputSampleR * figureR[4]) - (tempSample * figureR[6]); + inputSampleR = tempSample; + + 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); + //decode Console5 + + long double groundSampleL = drySampleL - inputSampleL; //set up UnBox + long double groundSampleR = drySampleR - inputSampleR; //set up UnBox + inputSampleL *= boost; //now, focussed area gets cranked before distort + inputSampleR *= boost; //now, focussed area gets cranked before distort + + switch (mode) + { + case 0: //Density + if (inputSampleL > 1.570796326794897) inputSampleL = 1.570796326794897; + if (inputSampleL < -1.570796326794897) inputSampleL = -1.570796326794897; + if (inputSampleR > 1.570796326794897) inputSampleR = 1.570796326794897; + if (inputSampleR < -1.570796326794897) inputSampleR = -1.570796326794897; + //clip to 1.570796326794897 to reach maximum output + inputSampleL = sin(inputSampleL); + inputSampleR = sin(inputSampleR); + break; + case 1: //Drive + 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; + inputSampleL -= (inputSampleL * (fabs(inputSampleL) * 0.6) * (fabs(inputSampleL) * 0.6)); + inputSampleR -= (inputSampleR * (fabs(inputSampleR) * 0.6) * (fabs(inputSampleR) * 0.6)); + inputSampleL *= 1.6; + inputSampleR *= 1.6; + break; + case 2: //Spiral + if (inputSampleL > 1.2533141373155) inputSampleL = 1.2533141373155; + if (inputSampleL < -1.2533141373155) inputSampleL = -1.2533141373155; + if (inputSampleR > 1.2533141373155) inputSampleR = 1.2533141373155; + if (inputSampleR < -1.2533141373155) inputSampleR = -1.2533141373155; + //clip to 1.2533141373155 to reach maximum output + inputSampleL = sin(inputSampleL * fabs(inputSampleL)) / ((inputSampleL == 0.0) ?1:fabs(inputSampleL)); + inputSampleR = sin(inputSampleR * fabs(inputSampleR)) / ((inputSampleR == 0.0) ?1:fabs(inputSampleR)); + break; + case 3: //Mojo + long double mojo; mojo = pow(fabs(inputSampleL),0.25); + if (mojo > 0.0) inputSampleL = (sin(inputSampleL * mojo * M_PI * 0.5) / mojo) * 0.987654321; + mojo = pow(fabs(inputSampleR),0.25); + if (mojo > 0.0) inputSampleR = (sin(inputSampleR * mojo * M_PI * 0.5) / mojo) * 0.987654321; + //mojo is the one that flattens WAAAAY out very softly before wavefolding + break; + case 4: //Dyno + long double dyno; dyno = pow(fabs(inputSampleL),4); + if (dyno > 0.0) inputSampleL = (sin(inputSampleL * dyno) / dyno) * 1.1654321; + dyno = pow(fabs(inputSampleR),4); + if (dyno > 0.0) inputSampleR = (sin(inputSampleR * dyno) / dyno) * 1.1654321; + //dyno is the one that tries to raise peak energy + break; + } + + if (output != 1.0) { + inputSampleL *= output; + inputSampleR *= output; + } + + inputSampleL += groundSampleL; //effectively UnBox + inputSampleR += groundSampleR; //effectively UnBox + + 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); + fpd ^= fpd << 13; fpd ^= fpd >> 17; fpd ^= fpd << 5; + inputSampleL += ((double(fpd)-uint32_t(0x7fffffff)) * 1.1e-44l * pow(2,expon+62)); + frexp((double)inputSampleR, &expon); + fpd ^= fpd << 13; fpd ^= fpd >> 17; fpd ^= fpd << 5; + inputSampleR += ((double(fpd)-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++; + } +} |