ref: 7b8c07617896add470f0bbfb0045e2844d1f0ec2
dir: /src/effects.c/
/*
* SoX Effects chain
* (c) 2007 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 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,
* Fifth Floor, 51 Franklin Street, Boston, MA 02111-1301, USA.
*/
#include "sox_i.h"
#include <assert.h>
#include <string.h>
#include <strings.h>
#undef sox_fail
#undef sox_report
#define sox_fail sox_message_filename=effp->handler.name,sox_fail
#define sox_report sox_message_filename=effp->handler.name,sox_report
/* Default effect handler functions for do-nothing situations: */
static int default_function(sox_effect_t * effp UNUSED)
{
return SOX_SUCCESS;
}
/* Pass through samples verbatim */
static int default_flow(sox_effect_t * effp UNUSED, const sox_ssample_t *ibuf UNUSED, sox_ssample_t *obuf UNUSED, sox_size_t *isamp, sox_size_t *osamp)
{
*isamp = *osamp = min(*isamp, *osamp);
memcpy(obuf, ibuf, *isamp * sizeof(*obuf));
return SOX_SUCCESS;
}
/* Inform no more samples to drain */
static int default_drain(sox_effect_t * effp UNUSED, sox_ssample_t *obuf UNUSED, sox_size_t *osamp)
{
*osamp = 0;
return SOX_EOF;
}
/* Check that no parameters have been given */
static int default_getopts(sox_effect_t * effp, int argc, char **argv UNUSED)
{
if (argc) {
sox_fail("takes no parameters");
return SOX_EOF;
}
return SOX_SUCCESS;
}
/* Partially initialise the effect structure; signal info will come later */
void sox_create_effect(sox_effect_t * effp, sox_effect_handler_t const * eh)
{
assert(eh);
memset(effp, 0, sizeof(*effp));
effp->global_info = &effects_global_info;
effp->handler = *eh;
if (!effp->handler.getopts) effp->handler.getopts = default_getopts;
if (!effp->handler.start ) effp->handler.start = default_function;
if (!effp->handler.flow ) effp->handler.flow = default_flow;
if (!effp->handler.drain ) effp->handler.drain = default_drain;
if (!effp->handler.stop ) effp->handler.stop = default_function;
if (!effp->handler.kill ) effp->handler.kill = default_function;
}
/* Effects chain: */
sox_effect_t * sox_effects[SOX_MAX_EFFECTS];
unsigned sox_neffects;
/* Effect can call in start() or flow() to set minimum input size to flow() */
int sox_effect_set_imin(sox_effect_t * effp, sox_size_t imin)
{
if (imin > sox_bufsiz / effp->flows) {
sox_fail("sox_bufsiz not big enough");
return SOX_EOF;
}
effp->imin = imin;
return SOX_SUCCESS;
}
/* Add an effect to the chain. *in is the input signal for this effect. *out is
* a suggestion as to what the output signal should be, but depending on its
* given options and *in, the effect can choose to do differently. Whatever
* output rate and channels the effect does produce are written back to *in,
* ready for the next effect in the chain.
*/
int sox_add_effect(sox_effect_t * effp, sox_signalinfo_t * in, sox_signalinfo_t
const * out) { int ret, (*start)(sox_effect_t * effp) =
effp->handler.start; unsigned f;
if (effp->handler.flags & SOX_EFF_NULL) {
sox_report("has no effect (is a proxy effect)");
return SOX_EFF_NULL;
}
effp->outinfo = effp->ininfo = *in;
if (effp->handler.flags & SOX_EFF_CHAN)
effp->outinfo.channels = out->channels;
if (effp->handler.flags & SOX_EFF_RATE)
effp->outinfo.rate = out->rate;
effp->flows =
(effp->handler.flags & SOX_EFF_MCHAN)? 1 : effp->ininfo.channels;
effp->clips = 0;
effp->imin = 0;
ret = start(effp);
if (ret == SOX_EFF_NULL) {
sox_report("has no effect in this configuration");
return SOX_EFF_NULL;
}
if (ret != SOX_SUCCESS)
return SOX_EOF;
*in = effp->outinfo;
if (sox_neffects == SOX_MAX_EFFECTS) {
sox_fail("Too many effects!");
return SOX_EOF;
}
sox_effects[sox_neffects] =
xcalloc(effp->flows, sizeof(sox_effects[sox_neffects][0]));
sox_effects[sox_neffects][0] = *effp;
for (f = 1; f < effp->flows; ++f) {
sox_effects[sox_neffects][f] = *effp;
sox_effects[sox_neffects][f].flow = f;
if (start(&sox_effects[sox_neffects][f]) != SOX_SUCCESS)
return SOX_EOF;
}
++sox_neffects;
return SOX_SUCCESS;
}
static sox_ssample_t **ibufc, **obufc; /* Channel interleave buffers */
static int flow_effect(unsigned n)
{
sox_effect_t * effp1 = &sox_effects[n - 1][0];
sox_effect_t * effp = &sox_effects[n][0];
int effstatus = SOX_SUCCESS;
sox_size_t i, f;
const sox_ssample_t *ibuf;
sox_size_t idone = effp1->olen - effp1->odone;
sox_size_t odone = sox_bufsiz - effp->olen;
if (effp->flows == 1) /* Run effect on all channels at once */
effstatus = effp->handler.flow(effp, &effp1->obuf[effp1->odone],
&effp->obuf[effp->olen], &idone, &odone);
else { /* Run effect on each channel individually */
sox_ssample_t *obuf = &effp->obuf[effp->olen];
sox_size_t idone_last, odone_last;
ibuf = &effp1->obuf[effp1->odone];
for (i = 0; i < idone; i += effp->flows)
for (f = 0; f < effp->flows; ++f)
ibufc[f][i / effp->flows] = *ibuf++;
for (f = 0; f < effp->flows; ++f) {
sox_size_t idonec = idone / effp->flows;
sox_size_t odonec = odone / effp->flows;
int eff_status_c = effp->handler.flow(&sox_effects[n][f],
ibufc[f], obufc[f], &idonec, &odonec);
if (f && (idonec != idone_last || odonec != odone_last)) {
sox_fail("flowed asymmetrically!");
effstatus = SOX_EOF;
}
idone_last = idonec;
odone_last = odonec;
if (eff_status_c != SOX_SUCCESS)
effstatus = SOX_EOF;
}
for (i = 0; i < odone_last; ++i)
for (f = 0; f < effp->flows; ++f)
*obuf++ = obufc[f][i];
idone = f * idone_last;
odone = f * odone_last;
}
effp1->odone += idone;
if (effp1->odone == effp1->olen)
effp1->odone = effp1->olen = 0;
else if (effp1->olen - effp1->odone < effp->imin ) { /* Need to refill? */
memmove(effp1->obuf, &effp1->obuf[effp1->odone], (effp1->olen - effp1->odone) * sizeof(*effp1->obuf));
effp1->olen -= effp1->odone;
effp1->odone = 0;
}
effp->olen += odone;
return effstatus == SOX_SUCCESS? SOX_SUCCESS : SOX_EOF;
}
/* The same as flow_effect but with no input */
static int drain_effect(unsigned n)
{
sox_effect_t * effp = &sox_effects[n][0];
int effstatus = SOX_SUCCESS;
sox_size_t i, f;
sox_size_t odone = sox_bufsiz - effp->olen;
if (effp->flows == 1) /* Run effect on all channels at once */
effstatus = effp->handler.drain(effp, &effp->obuf[effp->olen], &odone);
else { /* Run effect on each channel individually */
sox_ssample_t *obuf = &effp->obuf[effp->olen];
sox_size_t odone_last;
for (f = 0; f < effp->flows; ++f) {
sox_size_t odonec = odone / effp->flows;
int eff_status_c = effp->handler.drain(&sox_effects[n][f], obufc[f], &odonec);
if (f && (odonec != odone_last)) {
sox_fail("drained asymmetrically!");
effstatus = SOX_EOF;
}
odone_last = odonec;
if (eff_status_c != SOX_SUCCESS)
effstatus = SOX_EOF;
}
for (i = 0; i < odone_last; ++i)
for (f = 0; f < effp->flows; ++f)
*obuf++ = obufc[f][i];
odone = f * odone_last;
}
if (!odone) /* This is the only thing that drain has and flow hasn't */
effstatus = SOX_EOF;
effp->olen += odone;
return effstatus == SOX_SUCCESS? SOX_SUCCESS : SOX_EOF;
}
/* Flow data through the effects chain until an effect or callback gives EOF */
int sox_flow_effects(int (* callback)(sox_bool all_done))
{
int flow_status = SOX_SUCCESS;
sox_size_t e, source_e = 0; /* effect indices */
sox_size_t f, max_flows = 0;
sox_bool draining = sox_true;
for (e = 0; e < sox_neffects; ++e) {
sox_effects[e][0].obuf = xmalloc(sox_bufsiz * sizeof(sox_effects[e][0].obuf[0]));
sox_effects[e][0].odone = sox_effects[e][0].olen = 0;
max_flows = max(max_flows, sox_effects[e][0].flows);
}
ibufc = xcalloc(max_flows, sizeof(*ibufc));
obufc = xcalloc(max_flows, sizeof(*obufc));
for (f = 0; f < max_flows; ++f) {
ibufc[f] = xcalloc(sox_bufsiz / 2, sizeof(ibufc[f][0]));
obufc[f] = xcalloc(sox_bufsiz / 2, sizeof(obufc[f][0]));
}
e = sox_neffects - 1;
while (source_e < sox_neffects) {
#define have_imin (sox_effects[e - 1][0].olen - sox_effects[e - 1][0].odone >= sox_effects[e][0].imin)
if (e == source_e && (draining || !have_imin)) {
if (drain_effect(e) == SOX_EOF) {
++source_e;
draining = sox_false;
}
} else if (have_imin && flow_effect(e) == SOX_EOF) {
flow_status = SOX_EOF;
source_e = e;
draining = sox_true;
}
if (sox_effects[e][0].olen > sox_effects[e][0].odone) /* False for output */
++e;
else if (e == source_e)
draining = sox_true;
else if ((int)--e < (int)source_e)
e = source_e;
if (callback && callback(source_e == sox_neffects) != SOX_SUCCESS) {
flow_status = SOX_EOF; /* Client has requested to stop the flow. */
break;
}
}
for (f = 0; f < max_flows; ++f) {
free(ibufc[f]);
free(obufc[f]);
}
free(obufc);
free(ibufc);
for (e = 0; e < sox_neffects; ++e)
free(sox_effects[e][0].obuf);
return flow_status;
}
/* Remove all effects from the chain */
void sox_delete_effects(void)
{
while (sox_neffects)
free(sox_effects[--sox_neffects]);
}
/* Effects library: */
sox_effect_fn_t sox_effect_fns[] = {
#define EFFECT(f) sox_##f##_effect_fn,
#include "effects.h"
#undef EFFECT
NULL
};
/* Find a named effect in the effects library */
sox_effect_handler_t const * sox_find_effect(char const * name)
{
int e;
for (e = 0; sox_effect_fns[e]; ++e) {
const sox_effect_handler_t *eh = sox_effect_fns[e] ();
if (eh && eh->name && strcasecmp(eh->name, name) == 0)
return eh; /* Found it. */
}
return NULL;
}