SquidgeDSP/core/Clipper.cpp

#include "Clipper.hpp"
#include <cmath>

Clipper::Clipper(float init_clip, ClipperMode init_mode)
    : clip_(init_clip), mode_(init_mode) {}

void Clipper::process(const float *in, float *out, uint32_t frames) {
  for (uint32_t i = 0; i < frames; ++i) {
    out[i] = clip(in[i]);
  }
}
void Clipper::processStereo(const float *inLeft, const float *inRight,
                            float *outLeft, float *outRight, uint32_t frames) {
  for (uint32_t i = 0; i < frames; ++i) {
    outLeft[i] = clip(inLeft[i]);
    outRight[i] = clip(inRight[i]);
  }
}

float Clipper::clip(const float in) {
  switch (mode_) {
  default:
  case kClipperModeHard: {
    float out = in;
    if (in > 0) {
      out = in > clip_ ? clip_ : in;
    } else {
      out = in < -clip_ ? -clip_ : in;
    }
    return out;
  }
  case kClipperModeSoft: {
    float normalized = (in / clip_) * 0.75f;
    return std::tanh(normalized) * clip_;
  }
  case kClipperModeFold: {
    float x = in;
    while (x > clip_ || x < -clip_) {
      if (x > clip_) {
        x = 2.0f * clip_ - x;
      } else if (x < -clip_) {
        x = -2.0f * clip_ - x;
      }
    }
    return x;
  }
  }
}