AudioEffect.h

#pragma once
#include "AudioEffects/AudioParameters.h"
#include "AudioEffects/PitchShift.h"
#include "AudioTools/AudioLogger.h"
#include "AudioTools/AudioTypes.h"
#include <stdint.h>
 
namespace audio_tools {
 
// we use int16_t for our effects
typedef int16_t effect_t;
 
class AudioEffect {
public:
  AudioEffect() = default;
  virtual ~AudioEffect() = default;
 
  virtual effect_t process(effect_t in) = 0;
 
  virtual void setActive(bool value) { active_flag = value; }
 
  virtual bool active() { return active_flag; }
 
  virtual AudioEffect *clone() = 0;
 
  int id() { return id_value; }
 
  void setId(int id) { this->id_value = id; }
 
protected:
  bool active_flag = true;
  int id_value = -1;
 
  void copyParent(AudioEffect *copy) {
    id_value = copy->id_value;
    active_flag = copy->active_flag;
  }
 
  int16_t clip(int32_t in, int16_t clipLimit = 32767,
               int16_t resultLimit = 32767) {
    int32_t result = in;
    if (result > clipLimit) {
      result = resultLimit;
    }
    if (result < -clipLimit) {
      result = -resultLimit;
    }
    return result;
  }
};
 
class Boost : public AudioEffect, public VolumeSupport {
public:
  Boost(float volume = 1.0) { setVolume(volume); }
 
  Boost(const Boost &copy) = default;
 
  effect_t process(effect_t input) {
    if (!active())
      return input;
    int32_t result = volume() * input;
    // clip to int16_t
    return clip(result);
  }
 
  Boost *clone() { return new Boost(*this); }
 
};
 
class Distortion : public AudioEffect {
public:
  Distortion(int16_t clipThreashold = 4990, int16_t maxInput = 6500) {
    p_clip_threashold = clipThreashold;
    max_input = maxInput;
  }
 
  Distortion(const Distortion &copy) = default;
 
  void setClipThreashold(int16_t th) { p_clip_threashold = th; }
 
  int16_t clipThreashold() { return p_clip_threashold; }
 
  void setMaxInput(int16_t maxInput) { max_input = maxInput; }
 
  int16_t maxInput() { return max_input; }
 
  effect_t process(effect_t input) {
    if (!active())
      return input;
    // the input signal is 16bits (values from -32768 to +32768
    // the value of input is clipped to the distortion_threshold value
    return clip(input, p_clip_threashold, max_input);
  }
 
  Distortion *clone() { return new Distortion(*this); }
 
protected:
  int16_t p_clip_threashold;
  int16_t max_input;
};
 
class Fuzz : public AudioEffect {
public:
  Fuzz(float fuzzEffectValue = 6.5, uint16_t maxOut = 300) {
    p_effect_value = fuzzEffectValue;
    max_out = maxOut;
  }
 
  Fuzz(const Fuzz &copy) = default;
 
  void setFuzzEffectValue(float v) { p_effect_value = v; }
 
  float fuzzEffectValue() { return p_effect_value; }
 
  void setMaxOut(uint16_t v) { max_out = v; }
 
  uint16_t maxOut() { return max_out; }
 
  effect_t process(effect_t input) {
    if (!active())
      return input;
    float v = p_effect_value;
    int32_t result = clip(v * input);
    return map(result * v, -32768, +32767, -max_out, max_out);
  }
 
  Fuzz *clone() { return new Fuzz(*this); }
 
protected:
  float p_effect_value;
  uint16_t max_out;
};
 
class Tremolo : public AudioEffect {
public:
  Tremolo(int16_t duration_ms = 2000, uint8_t depthPercent = 50,
          uint32_t sampleRate = 44100) {
    this->duration_ms = duration_ms;
    this->sampleRate = sampleRate;
    this->p_percent = depthPercent;
    int32_t rate_count = sampleRate * duration_ms / 1000;
    rate_count_half = rate_count / 2;
  }
 
  Tremolo(const Tremolo &copy) = default;
 
  void setDuration(int16_t ms) {
    this->duration_ms = ms;
    int32_t rate_count = sampleRate * ms / 1000;
    rate_count_half = rate_count / 2;
  }
 
  int16_t duration() { return duration_ms; }
 
  void setDepth(uint8_t percent) { p_percent = percent; }
 
  uint8_t depth() { return p_percent; }
 
  effect_t process(effect_t input) {
    if (!active())
      return input;
 
    // limit value to max 100% and calculate factors
    float tremolo_depth = p_percent > 100 ? 1.0 : 0.01 * p_percent;
    float signal_depth = (100.0 - p_percent) / 100.0;
 
    float tremolo_factor = tremolo_depth / rate_count_half;
    int32_t out = (signal_depth * input) + (tremolo_factor * count * input);
 
    // saw tooth shaped counter
    count += inc;
    if (count >= rate_count_half) {
      inc = -1;
    } else if (count <= 0) {
      inc = +1;
    }
 
    return clip(out);
  }
 
  Tremolo *clone() { return new Tremolo(*this); }
 
protected:
  int16_t duration_ms;
  uint32_t sampleRate;
  int32_t count = 0;
  int16_t inc = 1;
  int32_t rate_count_half; // number of samples for on raise and fall
  uint8_t p_percent;
};
 
class Delay : public AudioEffect {
public:
  Delay(uint16_t duration_ms = 1000, float depth = 0.5,
        float feedbackAmount = 1.0, uint32_t sampleRate = 44100) {
    setSampleRate(sampleRate);
    setFeedback(feedbackAmount);
    setDepth(depth);
    setDuration(duration_ms);
  }
 
  Delay(const Delay &copy) {
    setSampleRate(copy.sampleRate);
    setFeedback(copy.feedback);
    setDepth(copy.depth);
    setDuration(copy.duration);
  };
 
  void setDuration(int16_t dur) {
    duration = dur;
    updateBufferSize();
  }
 
  int16_t getDuration() { return duration; }
 
  void setDepth(float value) {
    depth = value;
    if (depth > 1.0)
      depth = 1.0;
    if (depth < 0)
      depth = 0.0;
  }
 
  float getDepth() { return depth; }
 
  void setFeedback(float feed) {
    feedback = feed;
    if (feedback > 1.0)
      feedback = 1.0;
    if (feedback < 0)
      feedback = 0.0;
  }
 
  float getFeedback() { return feedback; }
 
  void setSampleRate(int32_t sample) {
    sampleRate = sample;
    updateBufferSize();
  }
 
  float getSampleRate() { return sampleRate; }
 
  effect_t process(effect_t input) {
    if (!active())
      return input;
 
    // Read last audio sample in each delay line
    int32_t delayed_value = buffer[delay_line_index];
 
    // Mix the above with current audio and write the results back to output
    int32_t out = ((1.0 - depth) * input) + (depth * delayed_value);
 
    // Update each delay line
    buffer[delay_line_index] = clip(feedback * (delayed_value + input));
 
    // Finally, update the delay line index
    if (delay_line_index++ >= delay_len_samples) {
      delay_line_index = 0;
    }
    return clip(out);
  }
 
  Delay *clone() { return new Delay(*this); }
 
protected:
  Vector<effect_t> buffer{0};
  float feedback = 0.0, duration = 0.0, sampleRate = 0.0, depth = 0.0;
  size_t delay_len_samples = 0;
  size_t delay_line_index = 0;
 
  void updateBufferSize() {
    if (sampleRate > 0 && duration > 0) {
      size_t newSampleCount = sampleRate * duration / 1000;
      if (newSampleCount != delay_len_samples) {
        delay_len_samples = newSampleCount;
        buffer.resize(delay_len_samples);
        memset(buffer.data(),0,delay_len_samples*sizeof(effect_t));
        LOGD("sample_count: %u", (unsigned)delay_len_samples);
      }
    }
  }
};
 
class ADSRGain : public AudioEffect {
public:
  ADSRGain(float attack = 0.001, float decay = 0.001, float sustainLevel = 0.5,
           float release = 0.005, float boostFactor = 1.0) {
    this->factor = boostFactor;
    adsr = new ADSR(attack, decay, sustainLevel, release);
  }
 
  ADSRGain(const ADSRGain &ref) {
    adsr = new ADSR(*(ref.adsr));
    factor = ref.factor;
    copyParent((AudioEffect *)&ref);
  };
 
  virtual ~ADSRGain() { delete adsr; }
 
  void setAttackRate(float a) { adsr->setAttackRate(a); }
 
  float attackRate() { return adsr->attackRate(); }
 
  void setDecayRate(float d) { adsr->setDecayRate(d); }
 
  float decayRate() { return adsr->decayRate(); }
 
  void setSustainLevel(float s) { adsr->setSustainLevel(s); }
 
  float sustainLevel() { return adsr->sustainLevel(); }
 
  void setReleaseRate(float r) { adsr->setReleaseRate(r); }
 
  float releaseRate() { return adsr->releaseRate(); }
 
  void keyOn(float tgt = 0) { adsr->keyOn(tgt); }
 
  void keyOff() { adsr->keyOff(); }
 
  effect_t process(effect_t input) {
    if (!active())
      return input;
    effect_t result = factor * adsr->tick() * input;
    return result;
  }
 
  bool isActive() { return adsr->isActive(); }
 
  ADSRGain *clone() { return new ADSRGain(*this); }
 
protected:
  ADSR *adsr;
  float factor;
};
 
class PitchShift : public AudioEffect {
public:
  PitchShift(float shift_value = 1.0, int buffer_size = 1000) {
    effect_value = shift_value;
    size = buffer_size;
    buffer.resize(buffer_size);
    buffer.setIncrement(shift_value);
  }
 
  PitchShift(const PitchShift &ref) {
    size = ref.size;
    effect_value = ref.effect_value;
    buffer.resize(size);
    buffer.setIncrement(effect_value);
  };
 
  float value() { return effect_value; }
 
  void setValue(float value) {
    effect_value = value;
    buffer.setIncrement(value);
  }
 
  effect_t process(effect_t input) {
    if (!active())
      return input;
    buffer.write(input);
    return buffer.read();
  }
 
  PitchShift *clone() { return new PitchShift(*this); }
 
protected:
  VariableSpeedRingBuffer<int16_t> buffer;
  float effect_value;
  int size;
};
 
 
class Compressor : public AudioEffect { 
public:    
    Compressor(const Compressor &copy) = default;
 
    Compressor(uint32_t sampleRate = 44100, uint16_t attackMs=30, uint16_t releaseMs=20, uint16_t holdMs=10, uint8_t thresholdPercent=10, float compressionRatio=0.5){
        //assuming 1 sample = 1/96kHz = ~10us
        //Attack -> 30 ms -> 3000
        //Release -> 20 ms -> 2000
        //Hold -> 10ms -> 1000
        sample_rate = sample_rate * attackMs / 1000;
        attack_count = sample_rate * attackMs / 1000;
        release_count = sample_rate * releaseMs / 1000;
        hold_count = sample_rate * holdMs / 1000; 
 
        //threshold -20dB below limit -> 0.1 * 2^31
        threshold = 0.01f * thresholdPercent * NumberConverter::maxValueT<effect_t>();
        //compression ratio: 6:1 -> -6dB = 0.5
        gainreduce = compressionRatio;
        //initial gain = 1.0 -> no compression
          gain = 1.0f;
        recalculate();
    }
 
    void setAttack(uint16_t attackMs){
        attack_count = sample_rate * attackMs / 1000;
        recalculate();
    }
 
    void setRelease(uint16_t releaseMs){
        release_count = sample_rate * releaseMs / 1000;
        recalculate();
    }
 
    void setHold(uint16_t holdMs){
        hold_count = sample_rate * holdMs / 1000; 
        recalculate();
    }
 
    void setThresholdPercent(uint8_t thresholdPercent){
        threshold = 0.01f * thresholdPercent * NumberConverter::maxValueT<effect_t>();
    }
 
    void setCompressionRatio(float compressionRatio){
      if (compressionRatio<1.0){
        gainreduce = compressionRatio;
      }
      recalculate();
    }
 
    effect_t process(effect_t input) {
        if (!active())
          return input;
        return compress(input);
    }
 
    Compressor *clone() { return new Compressor(*this); }
 
protected:
    enum CompStates {S_NoOperation, S_Attack, S_GainReduction, S_Release };
    enum CompStates state = S_NoOperation;
 
    int32_t attack_count, release_count, hold_count,  timeout;
    float gainreduce, gain_step_attack, gain_step_release, gain, threshold;
    uint32_t sample_rate;
 
    void recalculate() {
        gain_step_attack = (1.0f - gainreduce) / attack_count;
        gain_step_release = (1.0f - gainreduce) / release_count;
    }
 
    float compress(float inSampleF){
        if (fabs(inSampleF) > threshold) {
            if (gain >=  gainreduce) {
                if (state==S_NoOperation) {
                    state=S_Attack;
                     timeout = attack_count;
                }
                else if (state==S_Release) {
                    state=S_Attack;
                     timeout = attack_count;
                }
            }
            if (state==S_GainReduction)  timeout = hold_count;
 
        }
 
        if (fabs(inSampleF) < threshold && gain <= 1.0f) {
            if ( timeout==0 && state==S_GainReduction) {
                state=S_Release;
                 timeout = release_count;
            }
        }
 
        switch (state) {
            case S_Attack:
                if ( timeout>0 && gain > gainreduce) {
                    gain -= gain_step_attack;
                     timeout--;
                }
                else {
                    state=S_GainReduction;
                     timeout = hold_count;
                }
                break;
 
 
            case S_GainReduction:
                if ( timeout>0)  timeout--;
                else {
                    state=S_Release;
                     timeout = release_count;
                }
                break;
 
 
            case S_Release:
                if ( timeout>0 && gain<1.0f) {
                     timeout--;
                    gain += gain_step_release;
                }
                else {
                    state=S_NoOperation;
                }
                break;
 
            case S_NoOperation:
                if (gain < 1.0f) gain = 1.0f;
                break;
 
            default:
                break;
 
        }
 
        float outSampleF = gain * inSampleF;
        return outSampleF;
    }
 
};
 
 
} // namespace audio_tools