您最多选择25个主题
主题必须以字母或数字开头，可以包含连字符 (-)，并且长度不得超过35个字符
376 行
13 KiB
376 行
13 KiB
/* 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]));
|
|
|
|
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));
|
|
}
|