github-starred/airwindows
2
0
Fork 0
mirror of https://github.com/airwindows/airwindows.git synced 2026-05-15 14:16:00 -06:00
Code Issues 33 Projects Packages Wiki Activity Actions
airwindows/plugins/MacAU/SmoothEQ2/SmoothEQ2.cpp
Christopher Johnson 05cb274c27 kCathedral5
2025-08-23 22:30:02 -04:00

446 lines
20 KiB
C++
Executable file
Raw Permalink Blame History

/*
* File: SmoothEQ2.cpp
*
* Version: 1.0
*
* Created: 8/14/25
*
* Copyright: Copyright © 2025 Airwindows, Airwindows uses the MIT license
*
* Disclaimer: IMPORTANT: This Apple software is supplied to you by Apple Computer, Inc. ("Apple") in
* consideration of your agreement to the following terms, and your use, installation, modification
* or redistribution of this Apple software constitutes acceptance of these terms. If you do
* not agree with these terms, please do not use, install, modify or redistribute this Apple
* software.
*
* In consideration of your agreement to abide by the following terms, and subject to these terms,
* Apple grants you a personal, non-exclusive license, under Apple's copyrights in this
* original Apple software (the "Apple Software"), to use, reproduce, modify and redistribute the
* Apple Software, with or without modifications, in source and/or binary forms; provided that if you
* redistribute the Apple Software in its entirety and without modifications, you must retain this
* notice and the following text and disclaimers in all such redistributions of the Apple Software.
* Neither the name, trademarks, service marks or logos of Apple Computer, Inc. may be used to
* endorse or promote products derived from the Apple Software without specific prior written
* permission from Apple. Except as expressly stated in this notice, no other rights or
* licenses, express or implied, are granted by Apple herein, including but not limited to any
* patent rights that may be infringed by your derivative works or by other works in which the
* Apple Software may be incorporated.
*
* The Apple Software is provided by Apple on an "AS IS" basis. APPLE MAKES NO WARRANTIES, EXPRESS OR
* IMPLIED, INCLUDING WITHOUT LIMITATION THE IMPLIED WARRANTIES OF NON-INFRINGEMENT, MERCHANTABILITY
* AND FITNESS FOR A PARTICULAR PURPOSE, REGARDING THE APPLE SOFTWARE OR ITS USE AND OPERATION ALONE
* OR IN COMBINATION WITH YOUR PRODUCTS.
*
* IN NO EVENT SHALL APPLE BE LIABLE FOR ANY SPECIAL, INDIRECT, INCIDENTAL OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) ARISING IN ANY WAY OUT OF THE USE,
* REPRODUCTION, MODIFICATION AND/OR DISTRIBUTION OF THE APPLE SOFTWARE, HOWEVER CAUSED AND WHETHER
* UNDER THEORY OF CONTRACT, TORT (INCLUDING NEGLIGENCE), STRICT LIABILITY OR OTHERWISE, EVEN
* IF APPLE HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
*/
/*=============================================================================
SmoothEQ2.cpp
=============================================================================*/
#include "SmoothEQ2.h"
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
COMPONENT_ENTRY(SmoothEQ2)
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
// SmoothEQ2::SmoothEQ2
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
SmoothEQ2::SmoothEQ2(AudioUnit component)
: AUEffectBase(component)
{
CreateElements();
Globals()->UseIndexedParameters(kNumberOfParameters);
SetParameter(kParam_A, kDefaultValue_ParamA );
SetParameter(kParam_B, kDefaultValue_ParamB );
SetParameter(kParam_C, kDefaultValue_ParamC );
SetParameter(kParam_D, kDefaultValue_ParamD );
SetParameter(kParam_E, kDefaultValue_ParamE );
SetParameter(kParam_F, kDefaultValue_ParamF );
SetParameter(kParam_G, kDefaultValue_ParamG );
SetParameter(kParam_H, kDefaultValue_ParamH );
#if AU_DEBUG_DISPATCHER
mDebugDispatcher = new AUDebugDispatcher (this);
#endif
}
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
// SmoothEQ2::GetParameterValueStrings
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
ComponentResult SmoothEQ2::GetParameterValueStrings(AudioUnitScope inScope,
AudioUnitParameterID inParameterID,
CFArrayRef * outStrings)
{
return kAudioUnitErr_InvalidProperty;
}
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
// SmoothEQ2::GetParameterInfo
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
ComponentResult SmoothEQ2::GetParameterInfo(AudioUnitScope inScope,
AudioUnitParameterID inParameterID,
AudioUnitParameterInfo &outParameterInfo )
{
ComponentResult result = noErr;
outParameterInfo.flags = kAudioUnitParameterFlag_IsWritable
| kAudioUnitParameterFlag_IsReadable;
if (inScope == kAudioUnitScope_Global) {
switch(inParameterID)
{
case kParam_A:
AUBase::FillInParameterName (outParameterInfo, kParameterAName, false);
outParameterInfo.unit = kAudioUnitParameterUnit_Generic;
outParameterInfo.minValue = 0.0;
outParameterInfo.maxValue = 1.0;
outParameterInfo.defaultValue = kDefaultValue_ParamA;
break;
case kParam_B:
AUBase::FillInParameterName (outParameterInfo, kParameterBName, false);
outParameterInfo.unit = kAudioUnitParameterUnit_Generic;
outParameterInfo.minValue = 0.0;
outParameterInfo.maxValue = 1.0;
outParameterInfo.defaultValue = kDefaultValue_ParamB;
break;
case kParam_C:
AUBase::FillInParameterName (outParameterInfo, kParameterCName, false);
outParameterInfo.unit = kAudioUnitParameterUnit_Generic;
outParameterInfo.minValue = 0.0;
outParameterInfo.maxValue = 1.0;
outParameterInfo.defaultValue = kDefaultValue_ParamC;
break;
case kParam_D:
AUBase::FillInParameterName (outParameterInfo, kParameterDName, false);
outParameterInfo.unit = kAudioUnitParameterUnit_Generic;
outParameterInfo.minValue = 0.0;
outParameterInfo.maxValue = 1.0;
outParameterInfo.defaultValue = kDefaultValue_ParamD;
break;
case kParam_E:
AUBase::FillInParameterName (outParameterInfo, kParameterEName, false);
outParameterInfo.unit = kAudioUnitParameterUnit_Generic;
outParameterInfo.minValue = 0.0;
outParameterInfo.maxValue = 1.0;
outParameterInfo.defaultValue = kDefaultValue_ParamE;
break;
case kParam_F:
AUBase::FillInParameterName (outParameterInfo, kParameterFName, false);
outParameterInfo.unit = kAudioUnitParameterUnit_Generic;
outParameterInfo.minValue = 0.0;
outParameterInfo.maxValue = 1.0;
outParameterInfo.defaultValue = kDefaultValue_ParamF;
break;
case kParam_G:
AUBase::FillInParameterName (outParameterInfo, kParameterGName, false);
outParameterInfo.unit = kAudioUnitParameterUnit_Generic;
outParameterInfo.minValue = 0.0;
outParameterInfo.maxValue = 1.0;
outParameterInfo.defaultValue = kDefaultValue_ParamG;
break;
case kParam_H:
AUBase::FillInParameterName (outParameterInfo, kParameterHName, false);
outParameterInfo.unit = kAudioUnitParameterUnit_Generic;
outParameterInfo.minValue = 0.0;
outParameterInfo.maxValue = 1.0;
outParameterInfo.defaultValue = kDefaultValue_ParamH;
break;
default:
result = kAudioUnitErr_InvalidParameter;
break;
}
} else {
result = kAudioUnitErr_InvalidParameter;
}
return result;
}
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
// SmoothEQ2::GetPropertyInfo
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
ComponentResult SmoothEQ2::GetPropertyInfo (AudioUnitPropertyID inID,
AudioUnitScope inScope,
AudioUnitElement inElement,
UInt32 & outDataSize,
Boolean & outWritable)
{
return AUEffectBase::GetPropertyInfo (inID, inScope, inElement, outDataSize, outWritable);
}
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
// SmoothEQ2::GetProperty
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
ComponentResult SmoothEQ2::GetProperty( AudioUnitPropertyID inID,
AudioUnitScope inScope,
AudioUnitElement inElement,
void * outData )
{
return AUEffectBase::GetProperty (inID, inScope, inElement, outData);
}
// SmoothEQ2::Initialize
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
ComponentResult SmoothEQ2::Initialize()
{
ComponentResult result = AUEffectBase::Initialize();
if (result == noErr)
Reset(kAudioUnitScope_Global, 0);
return result;
}
#pragma mark ____SmoothEQ2EffectKernel
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
// SmoothEQ2::SmoothEQ2Kernel::Reset()
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
void SmoothEQ2::SmoothEQ2Kernel::Reset()
{
for (int x = 0; x < biq_total; x++) {
highA[x] = 0.0;
highB[x] = 0.0;
highC[x] = 0.0;
midA[x] = 0.0;
midB[x] = 0.0;
midC[x] = 0.0;
lowA[x] = 0.0;
lowB[x] = 0.0;
lowC[x] = 0.0;
}
highIIR = 0.0;
midIIR = 0.0;
lowIIR = 0.0;
fpd = 1.0; while (fpd < 16386) fpd = rand()*UINT32_MAX;
}
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
// SmoothEQ2::SmoothEQ2Kernel::Process
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
void SmoothEQ2::SmoothEQ2Kernel::Process( const Float32 *inSourceP,
Float32 *inDestP,
UInt32 inFramesToProcess,
UInt32 inNumChannels,
bool &ioSilence )
{
UInt32 nSampleFrames = inFramesToProcess;
const Float32 *sourceP = inSourceP;
Float32 *destP = inDestP;
double trebleGain = (GetParameter( kParam_A )-0.5)*2.0;
trebleGain = 1.0+(trebleGain*fabs(trebleGain)*fabs(trebleGain));
double highmidGain = (GetParameter( kParam_B )-0.5)*2.0;
highmidGain = 1.0+(highmidGain*fabs(highmidGain)*fabs(highmidGain));
double lowmidGain = (GetParameter( kParam_C )-0.5)*2.0;
lowmidGain = 1.0+(lowmidGain*fabs(lowmidGain)*fabs(lowmidGain));
double bassGain = (GetParameter( kParam_D )-0.5)*2.0;
bassGain = 1.0+(bassGain*fabs(bassGain)*fabs(bassGain));
double trebleRef = GetParameter( kParam_E )-0.5;
double highmidRef = GetParameter( kParam_F )-0.5;
double lowmidRef = GetParameter( kParam_G )-0.5;
double bassRef = GetParameter( kParam_H )-0.5;
double highF = 0.75 + ((trebleRef+trebleRef+trebleRef+highmidRef)*0.125);
double bassF = 0.25 + ((lowmidRef+bassRef+bassRef+bassRef)*0.125);
double midF = (highF*0.5) + (bassF*0.5) + ((highmidRef+lowmidRef)*0.125);
double highQ = fmax(fmin(1.0+(highmidRef-trebleRef),4.0),0.125);
double midQ = fmax(fmin(1.0+(lowmidRef-highmidRef),4.0),0.125);
double lowQ = fmax(fmin(1.0+(bassRef-lowmidRef),4.0),0.125);
highA[biq_freq] = ((pow(highF,3)*20000.0)/GetSampleRate());
highC[biq_freq] = highB[biq_freq] = highA[biq_freq] = fmax(fmin(highA[biq_freq],0.4999),0.00025);
double highFreq = pow(highF,3)*20000.0;
double omega = 2.0*M_PI*(highFreq/GetSampleRate());
double K = 2.0-cos(omega);
double highCoef = -sqrt((K*K)-1.0)+K;
highA[biq_reso] = 2.24697960 * highQ;
highB[biq_reso] = 0.80193774 * highQ;
highC[biq_reso] = 0.55495813 * highQ;
midA[biq_freq] = ((pow(midF,3)*20000.0)/GetSampleRate());
midC[biq_freq] = midB[biq_freq] = midA[biq_freq] = fmax(fmin(midA[biq_freq],0.4999),0.00025);
double midFreq = pow(midF,3)*20000.0;
omega = 2.0*M_PI*(midFreq/GetSampleRate());
K = 2.0-cos(omega);
double midCoef = -sqrt((K*K)-1.0)+K;
midA[biq_reso] = 2.24697960 * midQ;
midB[biq_reso] = 0.80193774 * midQ;
midC[biq_reso] = 0.55495813 * midQ;
lowA[biq_freq] = ((pow(bassF,3)*20000.0)/GetSampleRate());
lowC[biq_freq] = lowB[biq_freq] = lowA[biq_freq] = fmax(fmin(lowA[biq_freq],0.4999),0.00025);
double lowFreq = pow(bassF,3)*20000.0;
omega = 2.0*M_PI*(lowFreq/GetSampleRate());
K = 2.0-cos(omega);
double lowCoef = -sqrt((K*K)-1.0)+K;
lowA[biq_reso] = 2.24697960 * lowQ;
lowB[biq_reso] = 0.80193774 * lowQ;
lowC[biq_reso] = 0.55495813 * lowQ;
K = tan(M_PI * highA[biq_freq]);
double norm = 1.0 / (1.0 + K / highA[biq_reso] + K * K);
highA[biq_a0] = K * K * norm;
highA[biq_a1] = 2.0 * highA[biq_a0];
highA[biq_a2] = highA[biq_a0];
highA[biq_b1] = 2.0 * (K * K - 1.0) * norm;
highA[biq_b2] = (1.0 - K / highA[biq_reso] + K * K) * norm;
K = tan(M_PI * highB[biq_freq]);
norm = 1.0 / (1.0 + K / highB[biq_reso] + K * K);
highB[biq_a0] = K * K * norm;
highB[biq_a1] = 2.0 * highB[biq_a0];
highB[biq_a2] = highB[biq_a0];
highB[biq_b1] = 2.0 * (K * K - 1.0) * norm;
highB[biq_b2] = (1.0 - K / highB[biq_reso] + K * K) * norm;
K = tan(M_PI * highC[biq_freq]);
norm = 1.0 / (1.0 + K / highC[biq_reso] + K * K);
highC[biq_a0] = K * K * norm;
highC[biq_a1] = 2.0 * highC[biq_a0];
highC[biq_a2] = highC[biq_a0];
highC[biq_b1] = 2.0 * (K * K - 1.0) * norm;
highC[biq_b2] = (1.0 - K / highC[biq_reso] + K * K) * norm;
K = tan(M_PI * midA[biq_freq]);
norm = 1.0 / (1.0 + K / midA[biq_reso] + K * K);
midA[biq_a0] = K * K * norm;
midA[biq_a1] = 2.0 * midA[biq_a0];
midA[biq_a2] = midA[biq_a0];
midA[biq_b1] = 2.0 * (K * K - 1.0) * norm;
midA[biq_b2] = (1.0 - K / midA[biq_reso] + K * K) * norm;
K = tan(M_PI * midB[biq_freq]);
norm = 1.0 / (1.0 + K / midB[biq_reso] + K * K);
midB[biq_a0] = K * K * norm;
midB[biq_a1] = 2.0 * midB[biq_a0];
midB[biq_a2] = midB[biq_a0];
midB[biq_b1] = 2.0 * (K * K - 1.0) * norm;
midB[biq_b2] = (1.0 - K / midB[biq_reso] + K * K) * norm;
K = tan(M_PI * midC[biq_freq]);
norm = 1.0 / (1.0 + K / midC[biq_reso] + K * K);
midC[biq_a0] = K * K * norm;
midC[biq_a1] = 2.0 * midC[biq_a0];
midC[biq_a2] = midC[biq_a0];
midC[biq_b1] = 2.0 * (K * K - 1.0) * norm;
midC[biq_b2] = (1.0 - K / midC[biq_reso] + K * K) * norm;
K = tan(M_PI * lowA[biq_freq]);
norm = 1.0 / (1.0 + K / lowA[biq_reso] + K * K);
lowA[biq_a0] = K * K * norm;
lowA[biq_a1] = 2.0 * lowA[biq_a0];
lowA[biq_a2] = lowA[biq_a0];
lowA[biq_b1] = 2.0 * (K * K - 1.0) * norm;
lowA[biq_b2] = (1.0 - K / lowA[biq_reso] + K * K) * norm;
K = tan(M_PI * lowB[biq_freq]);
norm = 1.0 / (1.0 + K / lowB[biq_reso] + K * K);
lowB[biq_a0] = K * K * norm;
lowB[biq_a1] = 2.0 * lowB[biq_a0];
lowB[biq_a2] = lowB[biq_a0];
lowB[biq_b1] = 2.0 * (K * K - 1.0) * norm;
lowB[biq_b2] = (1.0 - K / lowB[biq_reso] + K * K) * norm;
K = tan(M_PI * lowC[biq_freq]);
norm = 1.0 / (1.0 + K / lowC[biq_reso] + K * K);
lowC[biq_a0] = K * K * norm;
lowC[biq_a1] = 2.0 * lowC[biq_a0];
lowC[biq_a2] = lowC[biq_a0];
lowC[biq_b1] = 2.0 * (K * K - 1.0) * norm;
lowC[biq_b2] = (1.0 - K / lowC[biq_reso] + K * K) * norm;
while (nSampleFrames-- > 0) {
double inputSampleL = *sourceP;
if (fabs(inputSampleL)<1.18e-23) inputSampleL = fpd * 1.18e-17;
double trebleL = inputSampleL;
double outSample = (trebleL * highA[biq_a0]) + highA[biq_sL1];
highA[biq_sL1] = (trebleL * highA[biq_a1]) - (outSample * highA[biq_b1]) + highA[biq_sL2];
highA[biq_sL2] = (trebleL * highA[biq_a2]) - (outSample * highA[biq_b2]);
double highmidL = outSample; trebleL -= highmidL;
outSample = (highmidL * midA[biq_a0]) + midA[biq_sL1];
midA[biq_sL1] = (highmidL * midA[biq_a1]) - (outSample * midA[biq_b1]) + midA[biq_sL2];
midA[biq_sL2] = (highmidL * midA[biq_a2]) - (outSample * midA[biq_b2]);
double lowmidL = outSample; highmidL -= lowmidL;
outSample = (lowmidL * lowA[biq_a0]) + lowA[biq_sL1];
lowA[biq_sL1] = (lowmidL * lowA[biq_a1]) - (outSample * lowA[biq_b1]) + lowA[biq_sL2];
lowA[biq_sL2] = (lowmidL * lowA[biq_a2]) - (outSample * lowA[biq_b2]);
double bassL = outSample; lowmidL -= bassL;
trebleL = (bassL*bassGain) + (lowmidL*lowmidGain) + (highmidL*highmidGain) + (trebleL*trebleGain);
//first stage of three crossovers
outSample = (trebleL * highB[biq_a0]) + highB[biq_sL1];
highB[biq_sL1] = (trebleL * highB[biq_a1]) - (outSample * highB[biq_b1]) + highB[biq_sL2];
highB[biq_sL2] = (trebleL * highB[biq_a2]) - (outSample * highB[biq_b2]);
highmidL = outSample; trebleL -= highmidL;
outSample = (highmidL * midB[biq_a0]) + midB[biq_sL1];
midB[biq_sL1] = (highmidL * midB[biq_a1]) - (outSample * midB[biq_b1]) + midB[biq_sL2];
midB[biq_sL2] = (highmidL * midB[biq_a2]) - (outSample * midB[biq_b2]);
lowmidL = outSample; highmidL -= lowmidL;
outSample = (lowmidL * lowB[biq_a0]) + lowB[biq_sL1];
lowB[biq_sL1] = (lowmidL * lowB[biq_a1]) - (outSample * lowB[biq_b1]) + lowB[biq_sL2];
lowB[biq_sL2] = (lowmidL * lowB[biq_a2]) - (outSample * lowB[biq_b2]);
bassL = outSample; lowmidL -= bassL;
trebleL = (bassL*bassGain) + (lowmidL*lowmidGain) + (highmidL*highmidGain) + (trebleL*trebleGain);
//second stage of three crossovers
outSample = (trebleL * highC[biq_a0]) + highC[biq_sL1];
highC[biq_sL1] = (trebleL * highC[biq_a1]) - (outSample * highC[biq_b1]) + highC[biq_sL2];
highC[biq_sL2] = (trebleL * highC[biq_a2]) - (outSample * highC[biq_b2]);
highmidL = outSample; trebleL -= highmidL;
outSample = (highmidL * midC[biq_a0]) + midC[biq_sL1];
midC[biq_sL1] = (highmidL * midC[biq_a1]) - (outSample * midC[biq_b1]) + midC[biq_sL2];
midC[biq_sL2] = (highmidL * midC[biq_a2]) - (outSample * midC[biq_b2]);
lowmidL = outSample; highmidL -= lowmidL;
outSample = (lowmidL * lowC[biq_a0]) + lowC[biq_sL1];
lowC[biq_sL1] = (lowmidL * lowC[biq_a1]) - (outSample * lowC[biq_b1]) + lowC[biq_sL2];
lowC[biq_sL2] = (lowmidL * lowC[biq_a2]) - (outSample * lowC[biq_b2]);
bassL = outSample; lowmidL -= bassL;
trebleL = (bassL*bassGain) + (lowmidL*lowmidGain) + (highmidL*highmidGain) + (trebleL*trebleGain);
//third stage of three crossovers
highIIR = (highIIR*highCoef) + (trebleL*(1.0-highCoef));
highmidL = highIIR; trebleL -= highmidL;
midIIR = (midIIR*midCoef) + (highmidL*(1.0-midCoef));
lowmidL = midIIR; highmidL -= lowmidL;
lowIIR = (lowIIR*lowCoef) + (lowmidL*(1.0-lowCoef));
bassL = lowIIR; lowmidL -= bassL;
inputSampleL = (bassL*bassGain) + (lowmidL*lowmidGain) + (highmidL*highmidGain) + (trebleL*trebleGain);
//fourth stage of three crossovers is the exponential filters
//begin 32 bit 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));
//end 32 bit floating point dither
*destP = inputSampleL;
sourceP += inNumChannels; destP += inNumChannels;
}
}
Reference in a new issue View git blame Copy permalink