diff options
Diffstat (limited to 'flow/gsl/gslwaveosc.c')
| -rw-r--r-- | flow/gsl/gslwaveosc.c | 376 |
1 files changed, 376 insertions, 0 deletions
diff --git a/flow/gsl/gslwaveosc.c b/flow/gsl/gslwaveosc.c new file mode 100644 index 0000000..a17c836 --- /dev/null +++ b/flow/gsl/gslwaveosc.c @@ -0,0 +1,376 @@ +/* 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., 59 Temple Place, Suite 330, + * Boston, MA 02111-1307, 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)); +} |