/* 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 #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 tqmask = wosc->last_mode ^ mode; if (tqmask & WOSC_MIX_WITH_SYNC) wosc->last_sync_level = 0; if (tqmask & 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 (tqmask & 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)); }