TDE
/
arts
mirror of https://mirror.git.trinitydesktop.org/gitea/TDE/arts
0
0
Fork 0
Code Issues Releases Wiki Activity
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
Branches Tags
${ item.name }
Create tag ${ searchTerm }
Create branch ${ searchTerm }
from '2e77fc272e'
${ noResults }
arts/flow/gsl/gslwaveosc.c

377 lines
13 KiB
Raw Blame History

/* GSL - Generic Sound Layer
* Copyright (C) 2001-2002 Tim Janik and Stefan Westerfeld
*
* This library is free software; you can redistribute it and/or modify
* it under the terms of the GNU Library 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 General Public License for more details.
*
* You should have received a copy of the GNU Library 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.
*/
#include "gslwaveosc.h"
#include "gslfilter.h"
#include "gslsignal.h"
#include "gslengine.h" /* for gsl_engine_sample_freq() */
#include <string.h>
#define FRAC_SHIFT (16)
#define FRAC_MASK ((1 << FRAC_SHIFT) - 1)
#define SIGNAL_LEVEL_INVAL (-2.0) /* trigger level-changed checks */
/* --- prototype --- */
static void wave_osc_transform_filter (GslWaveOscData *wosc,
gfloat play_freq);
/* --- generated function variants --- */
#define WOSC_MIX_VARIANT_INVAL (0xffffffff)
#define WOSC_MIX_WITH_SYNC (1)
#define WOSC_MIX_WITH_FREQ (2)
#define WOSC_MIX_WITH_MOD (4)
#define WOSC_MIX_WITH_EXP_FM (8)
#define WOSC_MIX_VARIANT_NAME wosc_process_sfme
#define WOSC_MIX_VARIANT (WOSC_MIX_WITH_SYNC | WOSC_MIX_WITH_FREQ | WOSC_MIX_WITH_MOD | WOSC_MIX_WITH_EXP_FM)
#include "gslwaveosc-aux.c"
#define WOSC_MIX_VARIANT_NAME wosc_process_sfm_
#define WOSC_MIX_VARIANT (WOSC_MIX_WITH_SYNC | WOSC_MIX_WITH_FREQ | WOSC_MIX_WITH_MOD | 0 )
#include "gslwaveosc-aux.c"
#if 0
#define WOSC_MIX_VARIANT_NAME wosc_process_sf_e
#define WOSC_MIX_VARIANT (WOSC_MIX_WITH_SYNC | WOSC_MIX_WITH_FREQ | 0 | WOSC_MIX_WITH_EXP_FM)
#include "gslwaveosc-aux.c"
#endif
#define WOSC_MIX_VARIANT_NAME wosc_process_sf__
#define WOSC_MIX_VARIANT (WOSC_MIX_WITH_SYNC | WOSC_MIX_WITH_FREQ | 0 | 0 )
#include "gslwaveosc-aux.c"
#define WOSC_MIX_VARIANT_NAME wosc_process_s_me
#define WOSC_MIX_VARIANT (WOSC_MIX_WITH_SYNC | 0 | WOSC_MIX_WITH_MOD | WOSC_MIX_WITH_EXP_FM)
#include "gslwaveosc-aux.c"
#define WOSC_MIX_VARIANT_NAME wosc_process_s_m_
#define WOSC_MIX_VARIANT (WOSC_MIX_WITH_SYNC | 0 | WOSC_MIX_WITH_MOD | 0 )
#include "gslwaveosc-aux.c"
#if 0
#define WOSC_MIX_VARIANT_NAME wosc_process_s__e
#define WOSC_MIX_VARIANT (WOSC_MIX_WITH_SYNC | 0 | 0 | WOSC_MIX_WITH_EXP_FM)
#include "gslwaveosc-aux.c"
#endif
#define WOSC_MIX_VARIANT_NAME wosc_process_s___
#define WOSC_MIX_VARIANT (WOSC_MIX_WITH_SYNC | 0 | 0 | 0 )
#include "gslwaveosc-aux.c"
#define WOSC_MIX_VARIANT_NAME wosc_process__fme
#define WOSC_MIX_VARIANT (0 | WOSC_MIX_WITH_FREQ | WOSC_MIX_WITH_MOD | WOSC_MIX_WITH_EXP_FM)
#include "gslwaveosc-aux.c"
#define WOSC_MIX_VARIANT_NAME wosc_process__fm_
#define WOSC_MIX_VARIANT (0 | WOSC_MIX_WITH_FREQ | WOSC_MIX_WITH_MOD | 0 )
#include "gslwaveosc-aux.c"
#if 0
#define WOSC_MIX_VARIANT_NAME wosc_process__f_e
#define WOSC_MIX_VARIANT (0 | WOSC_MIX_WITH_FREQ | 0 | WOSC_MIX_WITH_EXP_FM)
#include "gslwaveosc-aux.c"
#endif
#define WOSC_MIX_VARIANT_NAME wosc_process__f__
#define WOSC_MIX_VARIANT (0 | WOSC_MIX_WITH_FREQ | 0 | 0 )
#include "gslwaveosc-aux.c"
#define WOSC_MIX_VARIANT_NAME wosc_process___me
#define WOSC_MIX_VARIANT (0 | 0 | WOSC_MIX_WITH_MOD | WOSC_MIX_WITH_EXP_FM)
#include "gslwaveosc-aux.c"
#define WOSC_MIX_VARIANT_NAME wosc_process___m_
#define WOSC_MIX_VARIANT (0 | 0 | WOSC_MIX_WITH_MOD | 0 )
#include "gslwaveosc-aux.c"
#if 0
#define WOSC_MIX_VARIANT_NAME wosc_process____e
#define WOSC_MIX_VARIANT (0 | 0 | 0 | WOSC_MIX_WITH_EXP_FM)
#include "gslwaveosc-aux.c"
#endif
#define WOSC_MIX_VARIANT_NAME wosc_process_____
#define WOSC_MIX_VARIANT (0 | 0 | 0 | 0 )
#include "gslwaveosc-aux.c"
/* --- functions --- */
gboolean
gsl_wave_osc_process (GslWaveOscData *wosc,
guint n_values,
const gfloat *freq_in,
const gfloat *mod_in,
const gfloat *sync_in,
gfloat *mono_out)
{
guint mode = 0;
g_return_val_if_fail (wosc != NULL, FALSE);
g_return_val_if_fail (n_values > 0, FALSE);
g_return_val_if_fail (mono_out != NULL, FALSE);
if_reject (!wosc->config.wchunk_from_freq)
return FALSE;
/* mode changes:
* freq_in: if (freq_in) last_freq=inval else set_filter()
* sync_in: last_sync=0
* mod_in: if (mod_in) last_mod=0 else if (freq_in) last_freq=inval else transform_filter()
* exp_mod: n/a
*/
if (sync_in)
mode |= WOSC_MIX_WITH_SYNC;
if (freq_in)
mode |= WOSC_MIX_WITH_FREQ;
if (mod_in)
mode |= WOSC_MIX_WITH_MOD;
if (wosc->config.exponential_fm)
mode |= WOSC_MIX_WITH_EXP_FM;
if_reject (mode != wosc->last_mode)
{
guint mask = wosc->last_mode ^ mode;
if (mask & WOSC_MIX_WITH_SYNC)
wosc->last_sync_level = 0;
if (mask & WOSC_MIX_WITH_FREQ)
{
if (freq_in)
wosc->last_freq_level = SIGNAL_LEVEL_INVAL;
else
gsl_wave_osc_set_filter (wosc, wosc->config.cfreq, FALSE);
}
if (mask & WOSC_MIX_WITH_MOD)
{
if (mod_in)
wosc->last_mod_level = 0;
else if (freq_in)
wosc->last_freq_level = SIGNAL_LEVEL_INVAL;
else /* !mod_in && !freq_in */
wave_osc_transform_filter (wosc, wosc->config.cfreq);
}
wosc->last_mode = mode;
}
switch (mode)
{
case 0 | 0 | 0 | 0:
case 0 | 0 | 0 | WOSC_MIX_WITH_EXP_FM:
wosc_process_____ (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case 0 | 0 | WOSC_MIX_WITH_MOD | 0:
wosc_process___m_ (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case 0 | 0 | WOSC_MIX_WITH_MOD | WOSC_MIX_WITH_EXP_FM:
wosc_process___me (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case 0 | WOSC_MIX_WITH_FREQ | 0 | 0:
case 0 | WOSC_MIX_WITH_FREQ | 0 | WOSC_MIX_WITH_EXP_FM:
wosc_process__f__ (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case 0 | WOSC_MIX_WITH_FREQ | WOSC_MIX_WITH_MOD | 0:
wosc_process__fm_ (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case 0 | WOSC_MIX_WITH_FREQ | WOSC_MIX_WITH_MOD | WOSC_MIX_WITH_EXP_FM:
wosc_process__fme (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case WOSC_MIX_WITH_SYNC | 0 | 0 | 0:
case WOSC_MIX_WITH_SYNC | 0 | 0 | WOSC_MIX_WITH_EXP_FM:
wosc_process_s___ (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case WOSC_MIX_WITH_SYNC | 0 | WOSC_MIX_WITH_MOD | 0:
wosc_process_s_m_ (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case WOSC_MIX_WITH_SYNC | 0 | WOSC_MIX_WITH_MOD | WOSC_MIX_WITH_EXP_FM:
wosc_process_s_me (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case WOSC_MIX_WITH_SYNC | WOSC_MIX_WITH_FREQ | 0 | 0:
case WOSC_MIX_WITH_SYNC | WOSC_MIX_WITH_FREQ | 0 | WOSC_MIX_WITH_EXP_FM:
wosc_process_sf__ (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case WOSC_MIX_WITH_SYNC | WOSC_MIX_WITH_FREQ | WOSC_MIX_WITH_MOD | 0:
wosc_process_sfm_ (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
case WOSC_MIX_WITH_SYNC | WOSC_MIX_WITH_FREQ | WOSC_MIX_WITH_MOD | WOSC_MIX_WITH_EXP_FM:
wosc_process_sfme (wosc, n_values, freq_in, mod_in, sync_in, mono_out);
break;
default:
g_assert_not_reached ();
}
if (wosc->y[0] != 0.0 &&
!(fabs (wosc->y[0]) > GSL_SIGNAL_EPSILON && fabs (wosc->y[0]) < GSL_SIGNAL_KAPPA))
{
guint i;
/*g_printerr ("clearing filter state at:\n");*/
for (i = 0; i < GSL_WAVE_OSC_FILTER_ORDER; i++)
{
/*g_printerr ("%u) %+.38f\n", i, wosc->y[i]);*/
if (GSL_DOUBLE_IS_INF (wosc->y[0]) || fabs (wosc->y[0]) > GSL_SIGNAL_KAPPA)
wosc->y[i] = GSL_DOUBLE_SIGN (wosc->y[0]) ? -1.0 : 1.0;
else
wosc->y[i] = 0.0;
}
}
g_assert (!GSL_DOUBLE_IS_NANINF (wosc->y[0]));
g_assert (!GSL_DOUBLE_IS_SUBNORMAL (wosc->y[0]));
wosc->done = (wosc->block.is_silent && /* FIXME, let filter state run out? */
((wosc->block.play_dir < 0 && wosc->block.offset < 0) ||
(wosc->block.play_dir > 0 && wosc->block.offset > wosc->wchunk->wave_length)));
return TRUE;
}
void
gsl_wave_osc_set_filter (GslWaveOscData *wosc,
gfloat play_freq,
gboolean clear_state)
{
gfloat zero_padding = 2;
gfloat step;
guint i, istep;
g_return_if_fail (play_freq > 0);
if_reject (!wosc->config.wchunk_from_freq)
return;
wosc->step_factor = zero_padding * wosc->wchunk->mix_freq;
wosc->step_factor /= wosc->wchunk->osc_freq * wosc->mix_freq;
step = wosc->step_factor * play_freq;
istep = step * (FRAC_MASK + 1.) + 0.5;
if (istep != wosc->istep)
{
gfloat nyquist_fact = GSL_PI * 2.0 / wosc->mix_freq, cutoff_freq = 18000, stop_freq = 24000;
gfloat empiric_filter_stability_limit = 6.;
gfloat filt_fact = CLAMP (1. / step,
1. / (empiric_filter_stability_limit * zero_padding),
1. / zero_padding /* spectrum half */);
gfloat freq_c = cutoff_freq * nyquist_fact * filt_fact;
gfloat freq_r = stop_freq * nyquist_fact * filt_fact;
/* FIXME: this should store filter roots and poles, so modulation does lp->lp transform */
wosc->istep = istep;
gsl_filter_tscheb2_lp (GSL_WAVE_OSC_FILTER_ORDER, freq_c, freq_r / freq_c, 0.18, wosc->a, wosc->b);
for (i = 0; i < GSL_WAVE_OSC_FILTER_ORDER + 1; i++)
wosc->a[i] *= zero_padding; /* scale to compensate for zero-padding */
for (i = 0; i < (GSL_WAVE_OSC_FILTER_ORDER + 1) / 2; i++) /* reverse bs */
{
gfloat t = wosc->b[GSL_WAVE_OSC_FILTER_ORDER - i];
wosc->b[GSL_WAVE_OSC_FILTER_ORDER - i] = wosc->b[i];
wosc->b[i] = t;
}
/*g_printerr ("filter: fc=%f fr=%f st=%f is=%u\n", freq_c/GSL_PI*2, freq_r/GSL_PI*2, step, wosc->istep);*/
}
if (clear_state)
{
/* clear filter state */
memset (wosc->y, 0, sizeof (wosc->y));
wosc->j = 0;
wosc->cur_pos = 0; /* might want to initialize with istep? */
}
}
static void
wave_osc_transform_filter (GslWaveOscData *wosc,
gfloat play_freq)
{
gfloat step;
guint istep;
step = wosc->step_factor * play_freq;
istep = step * (FRAC_MASK + 1.) + 0.5;
if (istep != wosc->istep)
{
wosc->istep = istep;
/* transform filter poles and roots, normalize filter, update a[] and b[] */
}
}
void
gsl_wave_osc_retrigger (GslWaveOscData *wosc,
gfloat base_freq)
{
g_return_if_fail (wosc != NULL);
if_reject (!wosc->config.wchunk_from_freq)
return;
if (wosc->wchunk)
gsl_wave_chunk_unuse_block (wosc->wchunk, &wosc->block);
wosc->wchunk = wosc->config.wchunk_from_freq (wosc->config.wchunk_data, base_freq);
wosc->block.play_dir = wosc->config.play_dir;
wosc->block.offset = wosc->config.start_offset;
gsl_wave_chunk_use_block (wosc->wchunk, &wosc->block);
wosc->x = wosc->block.start + wosc->config.channel;
/*g_printerr ("wave lookup: want=%f got=%f length=%lu\n",
base_freq, wosc->wchunk->osc_freq, wosc->wchunk->wave_length);*/
wosc->last_freq_level = GSL_SIGNAL_FROM_FREQ (base_freq);
wosc->last_mod_level = 0;
gsl_wave_osc_set_filter (wosc, base_freq, TRUE);
}
void
gsl_wave_osc_config (GslWaveOscData *wosc,
GslWaveOscConfig *config)
{
g_return_if_fail (wosc != NULL);
g_return_if_fail (config != NULL);
if (wosc->config.wchunk_data != config->wchunk_data ||
wosc->config.wchunk_from_freq != config->wchunk_from_freq ||
wosc->config.channel != config->channel)
{
if (wosc->wchunk)
gsl_wave_chunk_unuse_block (wosc->wchunk, &wosc->block);
wosc->wchunk = NULL;
wosc->config = *config;
gsl_wave_osc_retrigger (wosc, wosc->config.cfreq);
}
else
{
wosc->config.play_dir = config->play_dir;
wosc->config.fm_strength = config->fm_strength;
if (wosc->config.cfreq != config->cfreq ||
wosc->config.start_offset != config->start_offset)
{
wosc->config.start_offset = config->start_offset;
wosc->config.cfreq = config->cfreq;
gsl_wave_osc_retrigger (wosc, wosc->config.cfreq);
}
}
}
void
gsl_wave_osc_init (GslWaveOscData *wosc)
{
g_return_if_fail (wosc != NULL);
g_assert (GSL_WAVE_OSC_FILTER_ORDER <= gsl_get_config ()->wave_chunk_padding);
memset (wosc, 0, sizeof (GslWaveOscData));
wosc->mix_freq = gsl_engine_sample_freq ();
}
void
gsl_wave_osc_shutdown (GslWaveOscData *wosc)
{
g_return_if_fail (wosc != NULL);
if (wosc->wchunk)
gsl_wave_chunk_unuse_block (wosc->wchunk, &wosc->block);
memset (wosc, 0xaa, sizeof (GslWaveOscData));
}
View Git Blame Copy Permalink