ref: 050b3330521b741c74c46c6d689f7be4ebc0a7a6
dir: /src/flanger.c/
/* libSoX effect: Stereo Flanger (c) 2006 robs@users.sourceforge.net * * This library is free software; you can redistribute it and/or modify it * under the terms of the GNU Lesser General Public License as published by * the Free Software Foundation; either version 2.1 of the License, or (at * your option) any later version. * * This library is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser * General Public License for more details. * * You should have received a copy of the GNU Lesser General Public License * along with this library; if not, write to the Free Software Foundation, * Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA */ /* TODO: Slide in the delay at the start? */ #include "sox_i.h" #include <string.h> typedef enum {INTERP_LINEAR, INTERP_QUADRATIC} interp_t; #define MAX_CHANNELS 4 typedef struct { /* Parameters */ double delay_min; double delay_depth; double feedback_gain; double delay_gain; double speed; lsx_wave_t wave_shape; double channel_phase; interp_t interpolation; /* Delay buffers */ double * delay_bufs[MAX_CHANNELS]; size_t delay_buf_length; size_t delay_buf_pos; double delay_last[MAX_CHANNELS]; /* Low Frequency Oscillator */ float * lfo; size_t lfo_length; size_t lfo_pos; /* Balancing */ double in_gain; } priv_t; static lsx_enum_item const interp_enum[] = { LSX_ENUM_ITEM(INTERP_,LINEAR) LSX_ENUM_ITEM(INTERP_,QUADRATIC) {0, 0}}; static int getopts(sox_effect_t * effp, int argc, char *argv[]) { priv_t * p = (priv_t *) effp->priv; --argc, ++argv; /* Set non-zero defaults: */ p->delay_depth = 2; p->delay_gain = 71; p->speed = 0.5; p->channel_phase= 25; do { /* break-able block */ NUMERIC_PARAMETER(delay_min , 0 , 30 ) NUMERIC_PARAMETER(delay_depth , 0 , 10 ) NUMERIC_PARAMETER(feedback_gain,-95 , 95 ) NUMERIC_PARAMETER(delay_gain , 0 , 100) NUMERIC_PARAMETER(speed , 0.1, 10 ) TEXTUAL_PARAMETER(wave_shape, lsx_get_wave_enum()) NUMERIC_PARAMETER(channel_phase, 0 , 100) TEXTUAL_PARAMETER(interpolation, interp_enum) } while (0); if (argc != 0) return lsx_usage(effp); lsx_report("parameters:\n" "delay = %gms\n" "depth = %gms\n" "regen = %g%%\n" "width = %g%%\n" "speed = %gHz\n" "shape = %s\n" "phase = %g%%\n" "interp= %s", p->delay_min, p->delay_depth, p->feedback_gain, p->delay_gain, p->speed, lsx_get_wave_enum()[p->wave_shape].text, p->channel_phase, interp_enum[p->interpolation].text); /* Scale to unity: */ p->feedback_gain /= 100; p->delay_gain /= 100; p->channel_phase /= 100; p->delay_min /= 1000; p->delay_depth /= 1000; return SOX_SUCCESS; } static int start(sox_effect_t * effp) { priv_t * f = (priv_t *) effp->priv; int c, channels = effp->in_signal.channels; if (channels > MAX_CHANNELS) { lsx_fail("Can not operate with more than %i channels", MAX_CHANNELS); return SOX_EOF; } /* Balance output: */ f->in_gain = 1 / (1 + f->delay_gain); f->delay_gain /= 1 + f->delay_gain; /* Balance feedback loop: */ f->delay_gain *= 1 - fabs(f->feedback_gain); lsx_debug("in_gain=%g feedback_gain=%g delay_gain=%g\n", f->in_gain, f->feedback_gain, f->delay_gain); /* Create the delay buffers, one for each channel: */ f->delay_buf_length = (f->delay_min + f->delay_depth) * effp->in_signal.rate + 0.5; ++f->delay_buf_length; /* Need 0 to n, i.e. n + 1. */ ++f->delay_buf_length; /* Quadratic interpolator needs one more. */ for (c = 0; c < channels; ++c) f->delay_bufs[c] = lsx_calloc(f->delay_buf_length, sizeof(*f->delay_bufs[0])); /* Create the LFO lookup table: */ f->lfo_length = effp->in_signal.rate / f->speed; f->lfo = lsx_calloc(f->lfo_length, sizeof(*f->lfo)); lsx_generate_wave_table( f->wave_shape, SOX_FLOAT, f->lfo, f->lfo_length, floor(f->delay_min * effp->in_signal.rate + .5), f->delay_buf_length - 2., 3 * M_PI_2); /* Start the sweep at minimum delay (for mono at least) */ lsx_debug("delay_buf_length=%" PRIuPTR " lfo_length=%" PRIuPTR "\n", f->delay_buf_length, f->lfo_length); return SOX_SUCCESS; } static int flow(sox_effect_t * effp, sox_sample_t const * ibuf, sox_sample_t * obuf, size_t * isamp, size_t * osamp) { priv_t * f = (priv_t *) effp->priv; int c, channels = effp->in_signal.channels; size_t len = (*isamp > *osamp ? *osamp : *isamp) / channels; *isamp = *osamp = len * channels; while (len--) { f->delay_buf_pos = (f->delay_buf_pos + f->delay_buf_length - 1) % f->delay_buf_length; for (c = 0; c < channels; ++c) { double delayed_0, delayed_1; double delayed; double in, out; size_t channel_phase = c * f->lfo_length * f->channel_phase + .5; double delay = f->lfo[(f->lfo_pos + channel_phase) % f->lfo_length]; double frac_delay = modf(delay, &delay); size_t int_delay = (size_t)delay; in = *ibuf++; f->delay_bufs[c][f->delay_buf_pos] = in + f->delay_last[c] * f->feedback_gain; delayed_0 = f->delay_bufs[c] [(f->delay_buf_pos + int_delay++) % f->delay_buf_length]; delayed_1 = f->delay_bufs[c] [(f->delay_buf_pos + int_delay++) % f->delay_buf_length]; if (f->interpolation == INTERP_LINEAR) delayed = delayed_0 + (delayed_1 - delayed_0) * frac_delay; else /* if (f->interpolation == INTERP_QUADRATIC) */ { double a, b; double delayed_2 = f->delay_bufs[c] [(f->delay_buf_pos + int_delay++) % f->delay_buf_length]; delayed_2 -= delayed_0; delayed_1 -= delayed_0; a = delayed_2 *.5 - delayed_1; b = delayed_1 * 2 - delayed_2 *.5; delayed = delayed_0 + (a * frac_delay + b) * frac_delay; } f->delay_last[c] = delayed; out = in * f->in_gain + delayed * f->delay_gain; *obuf++ = SOX_ROUND_CLIP_COUNT(out, effp->clips); } f->lfo_pos = (f->lfo_pos + 1) % f->lfo_length; } return SOX_SUCCESS; } static int stop(sox_effect_t * effp) { priv_t * f = (priv_t *) effp->priv; int c, channels = effp->in_signal.channels; for (c = 0; c < channels; ++c) free(f->delay_bufs[c]); free(f->lfo); memset(f, 0, sizeof(*f)); return SOX_SUCCESS; } sox_effect_handler_t const * lsx_flanger_effect_fn(void) { static sox_effect_handler_t handler = { "flanger", NULL, SOX_EFF_MCHAN, getopts, start, flow, NULL, stop, NULL, sizeof(priv_t)}; static char const * lines[] = { "[delay depth regen width speed shape phase interp]", " .", " /|regen", " / |", " +--( |------------+", " | \\ | | .", " _V_ \\| _______ | |\\ width ___", " | | ' | | | | \\ | |", " +-->| + |---->| DELAY |--+-->| )----->| |", " | |___| |_______| | / | |", " | delay : depth |/ | |", " In | : interp ' | | Out", " --->+ __:__ | + |--->", " | | |speed | |", " | | ~ |shape | |", " | |_____|phase | |", " +------------------------------------->| |", " |___|", " RANGE DEFAULT DESCRIPTION", "delay 0 30 0 base delay in milliseconds", "depth 0 10 2 added swept delay in milliseconds", "regen -95 +95 0 percentage regeneration (delayed signal feedback)", "width 0 100 71 percentage of delayed signal mixed with original", "speed 0.1 10 0.5 sweeps per second (Hz) ", "shape -- sin swept wave shape: sine|triangle", "phase 0 100 25 swept wave percentage phase-shift for multi-channel", " (e.g. stereo) flange; 0 = 100 = same phase on each channel", "interp -- lin delay-line interpolation: linear|quadratic" }; static char * usage; handler.usage = lsx_usage_lines(&usage, lines, array_length(lines)); return &handler; }