equalizer.cpp.hpp

Go to the documentation of this file.

#include "fl/audio/detector/equalizer.h"
#include "fl/audio/audio_context.h"
#include "fl/audio/mic_response_data.h"
#include "fl/audio/fft/fft.h"
#include "fl/math/math.h"
#include "fl/stl/noexcept.h"
 
namespace fl {
namespace audio {
namespace detector {
 
namespace {
// Bin-to-band mapping (WLED style):
// Bass:   bins 0-3   (~90-320 Hz)
// Mid:    bins 4-10  (~320-2560 Hz)
// Treble: bins 11-15 (~2560-5120 Hz)
const int kBassStart = 0;
const int kBassEnd = 3;
const int kMidStart = 4;
const int kMidEnd = 10;
const int kTrebleStart = 11;
const int kTrebleEnd = 15;

inline float applyScaling(float value, FFTScalingMode mode) {
    switch (mode) {
    case FFTScalingMode::SquareRoot:
        return fl::sqrtf(value);
    case FFTScalingMode::Logarithmic:
        return fl::logf(1.0f + value);
    case FFTScalingMode::None:
    case FFTScalingMode::Linear:
    default:
        return value;
    }
}
 
} // namespace
 
EqualizerDetector::EqualizerDetector()
{
    mBinMaxFilters.reserve(kNumBins);
    mBinSmoothers.reserve(kNumBins);
    for (int i = 0; i < kNumBins; ++i) {
        mBinMaxFilters.push_back(AttackDecayFilter<float>(mConfig.normAttack, mConfig.normDecay, 0.0f));
        mBinSmoothers.push_back(ExponentialSmoother<float>(mConfig.smoothing));
    }
    mVolumeMax = AttackDecayFilter<float>(mConfig.normAttack, mConfig.normDecay, 0.0f);
    // Initialize mic gains to 1.0 (no correction)
    for (int i = 0; i < kNumBins; ++i) {
        mMicGains[i] = 1.0f;
    }
    recomputePinkNoiseGains();
}
 
EqualizerDetector::~EqualizerDetector() FL_NOEXCEPT = default;
 
void EqualizerDetector::configure(const EqualizerConfig& config) {
    mConfig = config;
    // Rebuild normalization filters
    mBinMaxFilters.clear();
    for (int i = 0; i < kNumBins; ++i) {
        mBinMaxFilters.push_back(AttackDecayFilter<float>(mConfig.normAttack, mConfig.normDecay, 0.0f));
    }
    mVolumeMax = AttackDecayFilter<float>(mConfig.normAttack, mConfig.normDecay, 0.0f);
 
    // Configure output smoothing: attack/decay or simple exponential
    mUseAttackDecaySmoothing = (mConfig.outputAttack > 0.0f && mConfig.outputDecay > 0.0f);
    mBinSmoothers.clear();
    mBinOutputFilters.clear();
    if (mUseAttackDecaySmoothing) {
        for (int i = 0; i < kNumBins; ++i) {
            mBinOutputFilters.push_back(
                AttackDecayFilter<float>(mConfig.outputAttack, mConfig.outputDecay, 0.0f));
        }
    } else {
        for (int i = 0; i < kNumBins; ++i) {
            mBinSmoothers.push_back(ExponentialSmoother<float>(mConfig.smoothing));
        }
    }
 
    // Configure spectral equalizer
    if (mConfig.curve != EqualizationCurve::Flat) {
        SpectralEqualizerConfig eqConfig;
        eqConfig.curve = mConfig.curve;
        eqConfig.numBands = kNumBins;
        mSpectralEq.configure(eqConfig);
    }
 
    // Recompute mic gains if a profile is set (handles freq range changes)
    if (mCurrentMicProfile != MicProfile::None) {
        setMicProfile(mCurrentMicProfile);
    }
 
    // Recompute pink noise gains (freq range may have changed)
    recomputePinkNoiseGains();
}
 
void EqualizerDetector::setMicProfile(MicProfile profile) {
    mCurrentMicProfile = profile;
    MicResponseCurve curve = getMicResponseCurve(profile);
    mHasMicCorrection = (curve.count > 0);
    if (mHasMicCorrection) {
        float binCenters[kNumBins];
        computeBinCenters(binCenters);
        downsampleMicResponse(curve, binCenters, kNumBins, mMicGains);
    } else {
        for (int i = 0; i < kNumBins; ++i) {
            mMicGains[i] = 1.0f;
        }
    }
}
 
void EqualizerDetector::computeBinCenters(float* out) const {
    // Log-spaced bin centers matching Bins::binToFreq formula
    float fmin = mConfig.minFreq;
    float fmax = mConfig.maxFreq;
    if (fmax <= fmin) fmax = fmin * 2.0f;
    float m = fl::logf(fmax / fmin);
    for (int i = 0; i < kNumBins; ++i) {
        out[i] = fmin * fl::expf(m * static_cast<float>(i) / static_cast<float>(kNumBins - 1));
    }
}
 
void EqualizerDetector::recomputePinkNoiseGains() {
    float binCenters[kNumBins];
    computeBinCenters(binCenters);
    computePinkNoiseGains(binCenters, kNumBins, mPinkNoiseGains);
}
 
void EqualizerDetector::update(shared_ptr<Context> context) {
    mSampleRate = context->getSampleRate();
 
    span<const i16> pcm = context->getPCM();
    if (pcm.size() == 0) return;
 
    const float dt = computeAudioDt(pcm.size(), mSampleRate);
 
    // Use Context's cached fft::FFT (shared across detector)
    mRetainedFFT = context->getFFT(kNumBins, mConfig.minFreq, mConfig.maxFreq);
    if (!mRetainedFFT) return;
    const fft::Bins& fftBins = *mRetainedFFT;
 
    const auto& raw = fftBins.raw();
    const int numBins = fl::min(static_cast<int>(raw.size()), kNumBins);
    float scaledBins[kNumBins] = {};
 
    // Fused loop: Steps 1-4 (Copy, mic correction, pink noise, gain, scaling)
    // Combined for better cache locality and reduced memory bandwidth
    const bool applyMicCorrection = mHasMicCorrection;
    const bool applyScalingMode = (mConfig.scalingMode != FFTScalingMode::None &&
                                    mConfig.scalingMode != FFTScalingMode::Linear);
    const bool applyGain = (mGain != 1.0f);
 
    for (int i = 0; i < numBins; ++i) {
        // Step 1: Copy raw and apply fft::FFT downscale
        float val = raw[i] * kFFTDownscale;
 
        // Step 2: Microphone correction
        if (applyMicCorrection) {
            val *= mMicGains[i];
        }
 
        // Step 2.5: Pink noise spectral tilt compensation
        val *= mPinkNoiseGains[i];
 
        // Step 3: Apply gain
        if (applyGain) {
            val *= mGain;
        }
 
        // Step 4: Apply fft::FFT scaling mode
        if (applyScalingMode) {
            val = applyScaling(val, mConfig.scalingMode);
        }
 
        scaledBins[i] = val;
    }
 
    // Step 5: Apply spectral equalization curve (if not flat)
    if (mConfig.curve != EqualizationCurve::Flat) {
        span<const float> inSpan(scaledBins, numBins);
        span<float> outSpan(mEqBuffer, numBins);
        mSpectralEq.apply(inSpan, outSpan);
        for (int i = 0; i < numBins; ++i) {
            scaledBins[i] = mEqBuffer[i];
        }
    }
 
    // Step 6: Smooth → track running max → normalize to 0.0-1.0
    for (int i = 0; i < numBins; ++i) {
        float smoothed;
        if (mUseAttackDecaySmoothing) {
            smoothed = mBinOutputFilters[i].update(scaledBins[i], dt);
        } else {
            smoothed = mBinSmoothers[i].update(scaledBins[i], dt);
        }
        float runningMax = mBinMaxFilters[i].update(smoothed, dt);
        if (runningMax < 0.001f) runningMax = 0.001f;
        mBins[i] = fl::min(1.0f, smoothed / runningMax);
    }
    // Zero any remaining bins
    for (int i = numBins; i < kNumBins; ++i) {
        mBins[i] = 0.0f;
    }
 
    // Bass = average of bins 0-3
    float bassSum = 0;
    for (int i = kBassStart; i <= kBassEnd; ++i) bassSum += mBins[i];
    mBass = bassSum / static_cast<float>(kBassEnd - kBassStart + 1);
 
    // Mid = average of bins 4-10
    float midSum = 0;
    for (int i = kMidStart; i <= kMidEnd; ++i) midSum += mBins[i];
    mMid = midSum / static_cast<float>(kMidEnd - kMidStart + 1);
 
    // Treble = average of bins 11-15
    float trebleSum = 0;
    for (int i = kTrebleStart; i <= kTrebleEnd; ++i) trebleSum += mBins[i];
    mTreble = trebleSum / static_cast<float>(kTrebleEnd - kTrebleStart + 1);
 
    // Volume = RMS of sample, normalized to 0.0-1.0
    float rms = context->getRMS();
    float volumeMax = mVolumeMax.update(rms, dt);
    if (volumeMax < 0.001f) volumeMax = 0.001f;
    mVolume = fl::min(1.0f, rms / volumeMax);
 
    // Volume normalization factor: 1/volumeMax tells the caller how much the
    // volume was scaled to reach 0-1 range. Higher = quieter input was amplified more.
    mVolumeNormFactor = (rms > 0.001f) ? (mVolume / rms) : 1.0f;
 
    // Silence detection: signal is silent when RMS is very low
    mIsSilence = (rms < mConfig.silenceThreshold);
 
    // Zero-crossing factor (already 0.0-1.0 from Sample)
    mZcf = context->getZCF();
 
    // P2: Dominant frequency detection from pre-normalization data (scaledBins).
    // Using scaledBins avoids the self-normalization bias where consistently
    // active bins always read as 1.0 regardless of actual magnitude.
    int peakBin = 0;
    float peakVal = 0.0f;
    float scaledSum = 0.0f;
    for (int i = 0; i < numBins; ++i) {
        scaledSum += scaledBins[i];
        if (scaledBins[i] > peakVal) {
            peakVal = scaledBins[i];
            peakBin = i;
        }
    }
    // Magnitude: peak relative to average across all bins (0-1 range).
    // Reflects how much the peak dominates the spectrum.
    float scaledAvg = (numBins > 0) ? (scaledSum / static_cast<float>(numBins)) : 0.0f;
    mDominantMagnitude = (scaledAvg > 0.001f)
        ? fl::min(1.0f, peakVal / (scaledAvg * static_cast<float>(numBins)))
        : 0.0f;
    mDominantFreqHz = fftBins.binToFreq(peakBin);
 
    // P2: Volume in dB referenced to full-scale i16 (32767.0)
    constexpr float kFullScale = 32767.0f;
    if (rms > mConfig.silenceThreshold) {
        mVolumeDb = 20.0f * fl::logf(rms / kFullScale) / fl::logf(10.0f);
        if (mVolumeDb < -100.0f) mVolumeDb = -100.0f;
    } else {
        mVolumeDb = -100.0f;
    }
}
 
void EqualizerDetector::fireCallbacks() {
    if (onEqualizer) {
        Equalizer eq;
        eq.bass = mBass;
        eq.mid = mMid;
        eq.treble = mTreble;
        eq.volume = mVolume;
        eq.zcf = mZcf;
        eq.volumeNormFactor = mVolumeNormFactor;
        eq.isSilence = mIsSilence;
        eq.bins = span<const float, Equalizer::kNumBins>(
            static_cast<const float*>(mBins), Equalizer::kNumBins);
        eq.dominantFreqHz = mDominantFreqHz;
        eq.dominantMagnitude = mDominantMagnitude;
        eq.volumeDb = mVolumeDb;
        onEqualizer(eq);
    }
}
 
void EqualizerDetector::reset() {
    for (int i = 0; i < kNumBins; ++i) {
        mBins[i] = 0.0f;
        mBinMaxFilters[i].reset(0.0f);
        if (mUseAttackDecaySmoothing) {
            if (i < static_cast<int>(mBinOutputFilters.size())) {
                mBinOutputFilters[i].reset(0.0f);
            }
        } else {
            if (i < static_cast<int>(mBinSmoothers.size())) {
                mBinSmoothers[i].reset();
            }
        }
    }
    mBass = 0;
    mMid = 0;
    mTreble = 0;
    mVolume = 0;
    mZcf = 0;
    mVolumeNormFactor = 1.0f;
    mIsSilence = false;
    mDominantFreqHz = 0.0f;
    mDominantMagnitude = 0.0f;
    mVolumeDb = -100.0f;
    mVolumeMax.reset(0.0f);
}
 
float EqualizerDetector::getBin(int index) const {
    if (index < 0 || index >= kNumBins) return 0.0f;
    return mBins[index];
}
 
} // namespace detector
} // namespace audio
} // namespace fl