mirror of
https://github.com/ZDoom/qzdoom.git
synced 2024-11-10 06:42:12 +00:00
4438 lines
145 KiB
C++
4438 lines
145 KiB
C++
/*
|
|
TiMidity++ -- MIDI to WAVE converter and player
|
|
Copyright (C) 1999-2002 Masanao Izumo <mo@goice.co.jp>
|
|
Copyright (C) 1995 Tuukka Toivonen <tt@cgs.fi>
|
|
|
|
This program is free software; you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation; either version 2 of the License, or
|
|
(at your option) any later version.
|
|
|
|
This program 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 General Public License
|
|
along with this program; if not, write to the Free Software
|
|
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*/
|
|
|
|
/*
|
|
* REVERB EFFECT FOR TIMIDITY++-1.X (Version 0.06e 1999/1/28)
|
|
*
|
|
* Copyright (C) 1997,1998,1999 Masaki Kiryu <mkiryu@usa.net>
|
|
* (http://w3mb.kcom.ne.jp/~mkiryu/)
|
|
*
|
|
* reverb.c -- main reverb engine.
|
|
*
|
|
*/
|
|
|
|
#include <string.h>
|
|
#include <stdint.h>
|
|
#include "timidity.h"
|
|
#include "tables.h"
|
|
#include "common.h"
|
|
#include "reverb.h"
|
|
#include "optcode.h"
|
|
|
|
namespace TimidityPlus
|
|
{
|
|
|
|
#define SYS_EFFECT_PRE_LPF
|
|
|
|
|
|
const double reverb_predelay_factor = 1.0;
|
|
const double freeverb_scaleroom = 0.28;
|
|
const double freeverb_offsetroom = 0.7;
|
|
|
|
#define MASTER_CHORUS_LEVEL 1.7
|
|
#define MASTER_DELAY_LEVEL 3.25
|
|
|
|
/* */
|
|
/* Dry Signal */
|
|
/* */
|
|
|
|
|
|
void Reverb::set_dry_signal(int32_t *buf, int32_t n)
|
|
{
|
|
int32_t i;
|
|
int32_t *dbuf = direct_buffer;
|
|
|
|
for(i = n - 1; i >= 0; i--)
|
|
{
|
|
dbuf[i] += buf[i];
|
|
}
|
|
}
|
|
|
|
void Reverb::set_dry_signal_xg(int32_t *sbuffer, int32_t n, int32_t level)
|
|
{
|
|
int32_t i;
|
|
int32_t count = n;
|
|
if(!level) {return;}
|
|
double send_level = (double)level / 127.0;
|
|
|
|
for(i = 0; i < count; i++)
|
|
{
|
|
direct_buffer[i] += int32_t(sbuffer[i] * send_level);
|
|
}
|
|
}
|
|
|
|
void Reverb::mix_dry_signal(int32_t *buf, int32_t n)
|
|
{
|
|
memcpy(buf, direct_buffer, sizeof(int32_t) * n);
|
|
memset(direct_buffer, 0, sizeof(int32_t) * n);
|
|
}
|
|
|
|
/* */
|
|
/* Effect Utilities */
|
|
/* */
|
|
static int isprime(int val)
|
|
{
|
|
int i;
|
|
if (val == 2) {return 1;}
|
|
if (val & 1)
|
|
{
|
|
for (i = 3; i < (int)sqrt((double)val) + 1; i += 2) {
|
|
if ((val % i) == 0) {return 0;}
|
|
}
|
|
return 1; /* prime */
|
|
}
|
|
else
|
|
{
|
|
return 0;
|
|
} /* even */
|
|
}
|
|
|
|
/*! delay */
|
|
void Reverb::free_delay(simple_delay *delay)
|
|
{
|
|
if(delay->buf != NULL)
|
|
{
|
|
free(delay->buf);
|
|
delay->buf = NULL;
|
|
}
|
|
}
|
|
|
|
void Reverb::set_delay(simple_delay *delay, int32_t size)
|
|
{
|
|
if(size < 1) {size = 1;}
|
|
free_delay(delay);
|
|
delay->buf = (int32_t *)safe_malloc(sizeof(int32_t) * size);
|
|
if(delay->buf == NULL) {return;}
|
|
delay->index = 0;
|
|
delay->size = size;
|
|
memset(delay->buf, 0, sizeof(int32_t) * delay->size);
|
|
}
|
|
|
|
void Reverb::do_delay(int32_t *stream, int32_t *buf, int32_t size, int32_t *index)
|
|
{
|
|
int32_t output;
|
|
output = buf[*index];
|
|
buf[*index] = *stream;
|
|
if (++*index >= size) {*index = 0;}
|
|
*stream = output;
|
|
}
|
|
|
|
/*! LFO (low frequency oscillator) */
|
|
void Reverb::init_lfo(lfo *lfo, double freq, int type, double phase)
|
|
{
|
|
int32_t i, cycle, diff;
|
|
|
|
lfo->count = 0;
|
|
lfo->freq = freq;
|
|
if (lfo->freq < 0.05) {lfo->freq = 0.05;}
|
|
cycle = (double)playback_rate / lfo->freq;
|
|
if (cycle < 1) {cycle = 1;}
|
|
lfo->cycle = cycle;
|
|
lfo->icycle = TIM_FSCALE((SINE_CYCLE_LENGTH - 1) / (double)cycle, 24) - 0.5;
|
|
diff = SINE_CYCLE_LENGTH * phase / 360.0;
|
|
|
|
if(lfo->type != type) { /* generate LFO waveform */
|
|
switch(type) {
|
|
case LFO_SINE:
|
|
for(i = 0; i < SINE_CYCLE_LENGTH; i++)
|
|
lfo->buf[i] = TIM_FSCALE((lookup_sine(i + diff) + 1.0) / 2.0, 16);
|
|
break;
|
|
case LFO_TRIANGULAR:
|
|
for(i = 0; i < SINE_CYCLE_LENGTH; i++)
|
|
lfo->buf[i] = TIM_FSCALE((lookup_triangular(i + diff) + 1.0) / 2.0, 16);
|
|
break;
|
|
default:
|
|
for(i = 0; i < SINE_CYCLE_LENGTH; i++) {lfo->buf[i] = TIM_FSCALE(0.5, 16);}
|
|
break;
|
|
}
|
|
}
|
|
lfo->type = type;
|
|
}
|
|
|
|
/* returned value is between 0 and (1 << 16) */
|
|
int32_t Reverb::do_lfo(lfo *lfo)
|
|
{
|
|
int32_t val;
|
|
val = lfo->buf[imuldiv24(lfo->count, lfo->icycle)];
|
|
if(++lfo->count == lfo->cycle) {lfo->count = 0;}
|
|
return val;
|
|
}
|
|
|
|
void Reverb::do_mod_delay(int32_t *stream, int32_t *buf, int32_t size, int32_t *rindex, int32_t *windex,
|
|
int32_t ndelay, int32_t depth, int32_t lfoval, int32_t *hist)
|
|
{
|
|
int32_t t1, t2;
|
|
if (++*windex == size) {*windex = 0;}
|
|
t1 = buf[*rindex];
|
|
t2 = imuldiv24(lfoval, depth);
|
|
*rindex = *windex - ndelay - (t2 >> 8);
|
|
if (*rindex < 0) {*rindex += size;}
|
|
t2 = 0xFF - (t2 & 0xFF);
|
|
*hist = t1 + imuldiv8(buf[*rindex] - *hist, t2);
|
|
buf[*windex] = *stream;
|
|
*stream = *hist;
|
|
}
|
|
|
|
/*! modulated allpass filter with allpass interpolation (for Plate Reverberator,...) */
|
|
void Reverb::free_mod_allpass(mod_allpass *delay)
|
|
{
|
|
if(delay->buf != NULL) {
|
|
free(delay->buf);
|
|
delay->buf = NULL;
|
|
}
|
|
}
|
|
|
|
void Reverb::set_mod_allpass(mod_allpass *delay, int32_t ndelay, int32_t depth, double feedback)
|
|
{
|
|
int32_t size = ndelay + depth + 1;
|
|
free_mod_allpass(delay);
|
|
delay->buf = (int32_t *)safe_malloc(sizeof(int32_t) * size);
|
|
if(delay->buf == NULL) {return;}
|
|
delay->rindex = 0;
|
|
delay->windex = 0;
|
|
delay->hist = 0;
|
|
delay->ndelay = ndelay;
|
|
delay->depth = depth;
|
|
delay->size = size;
|
|
delay->feedback = feedback;
|
|
delay->feedbacki = TIM_FSCALE(feedback, 24);
|
|
memset(delay->buf, 0, sizeof(int32_t) * delay->size);
|
|
}
|
|
|
|
void Reverb::do_mod_allpass(int32_t *stream, int32_t *buf, int32_t size, int32_t *rindex, int32_t *windex,
|
|
int32_t ndelay, int32_t depth, int32_t lfoval, int32_t *hist, int32_t feedback)
|
|
{
|
|
int t1, t2, t3;
|
|
if (++*windex == size) {*windex = 0;}
|
|
t3 = *stream + imuldiv24(*hist, feedback);
|
|
t1 = buf[*rindex];
|
|
t2 = imuldiv24(lfoval, depth);
|
|
*rindex = *windex - ndelay - (t2 >> 8);
|
|
if (*rindex < 0) {*rindex += size;}
|
|
t2 = 0xFF - (t2 & 0xFF);
|
|
*hist = t1 + imuldiv8(buf[*rindex] - *hist, t2);
|
|
buf[*windex] = t3;
|
|
*stream = *hist - imuldiv24(t3, feedback);
|
|
}
|
|
|
|
/* allpass filter */
|
|
void Reverb::free_allpass(allpass *allpass)
|
|
{
|
|
if(allpass->buf != NULL) {
|
|
free(allpass->buf);
|
|
allpass->buf = NULL;
|
|
}
|
|
}
|
|
|
|
void Reverb::set_allpass(allpass *allpass, int32_t size, double feedback)
|
|
{
|
|
if(allpass->buf != NULL) {
|
|
free(allpass->buf);
|
|
allpass->buf = NULL;
|
|
}
|
|
allpass->buf = (int32_t *)safe_malloc(sizeof(int32_t) * size);
|
|
if(allpass->buf == NULL) {return;}
|
|
allpass->index = 0;
|
|
allpass->size = size;
|
|
allpass->feedback = feedback;
|
|
allpass->feedbacki = TIM_FSCALE(feedback, 24);
|
|
memset(allpass->buf, 0, sizeof(int32_t) * allpass->size);
|
|
}
|
|
|
|
void Reverb::do_allpass(int32_t *stream, int32_t *buf, int32_t size, int32_t *index, int32_t feedback)
|
|
{
|
|
int32_t bufout, output;
|
|
bufout = buf[*index];
|
|
output = *stream - imuldiv24(bufout, feedback);
|
|
buf[*index] = output;
|
|
if (++*index >= size) {*index = 0;}
|
|
*stream = bufout + imuldiv24(output, feedback);
|
|
}
|
|
|
|
void Reverb::init_filter_moog(filter_moog *svf)
|
|
{
|
|
svf->b0 = svf->b1 = svf->b2 = svf->b3 = svf->b4 = 0;
|
|
}
|
|
|
|
/*! calculate Moog VCF coefficients */
|
|
void Reverb::calc_filter_moog(filter_moog *svf)
|
|
{
|
|
double res, fr, p, q, f;
|
|
|
|
if (svf->freq > playback_rate / 2) {svf->freq = playback_rate / 2;}
|
|
else if(svf->freq < 20) {svf->freq = 20;}
|
|
|
|
if(svf->freq != svf->last_freq || svf->res_dB != svf->last_res_dB) {
|
|
if(svf->last_freq == 0) {init_filter_moog(svf);}
|
|
svf->last_freq = svf->freq, svf->last_res_dB = svf->res_dB;
|
|
|
|
res = pow(10, (svf->res_dB - 96) / 20);
|
|
fr = 2.0 * (double)svf->freq / (double)playback_rate;
|
|
q = 1.0 - fr;
|
|
p = fr + 0.8 * fr * q;
|
|
f = p + p - 1.0;
|
|
q = res * (1.0 + 0.5 * q * (1.0 - q + 5.6 * q * q));
|
|
svf->f = TIM_FSCALE(f, 24);
|
|
svf->p = TIM_FSCALE(p, 24);
|
|
svf->q = TIM_FSCALE(q, 24);
|
|
}
|
|
}
|
|
|
|
void Reverb::do_filter_moog(int32_t *stream, int32_t *high, int32_t f, int32_t p, int32_t q,
|
|
int32_t *b0, int32_t *b1, int32_t *b2, int32_t *b3, int32_t *b4)
|
|
{
|
|
int32_t t1, t2, t3, tb0 = *b0, tb1 = *b1, tb2 = *b2, tb3 = *b3, tb4 = *b4;
|
|
t3 = *stream - imuldiv24(q, tb4);
|
|
t1 = tb1; tb1 = imuldiv24(t3 + tb0, p) - imuldiv24(tb1, f);
|
|
t2 = tb2; tb2 = imuldiv24(tb1 + t1, p) - imuldiv24(tb2, f);
|
|
t1 = tb3; tb3 = imuldiv24(tb2 + t2, p) - imuldiv24(tb3, f);
|
|
*stream = tb4 = imuldiv24(tb3 + t1, p) - imuldiv24(tb4, f);
|
|
tb0 = t3;
|
|
*stream = tb4;
|
|
*high = t3 - tb4;
|
|
*b0 = tb0, *b1 = tb1, *b2 = tb2, *b3 = tb3, *b4 = tb4;
|
|
}
|
|
|
|
void Reverb::init_filter_moog_dist(filter_moog_dist *svf)
|
|
{
|
|
svf->b0 = svf->b1 = svf->b2 = svf->b3 = svf->b4 = 0.0;
|
|
}
|
|
|
|
/*! calculate Moog VCF coefficients */
|
|
void Reverb::calc_filter_moog_dist(filter_moog_dist *svf)
|
|
{
|
|
double res, fr, p, q, f;
|
|
|
|
if (svf->freq > playback_rate / 2) {svf->freq = playback_rate / 2;}
|
|
else if (svf->freq < 20) {svf->freq = 20;}
|
|
|
|
if (svf->freq != svf->last_freq || svf->res_dB != svf->last_res_dB
|
|
|| svf->dist != svf->last_dist) {
|
|
if (svf->last_freq == 0) {init_filter_moog_dist(svf);}
|
|
svf->last_freq = svf->freq, svf->last_res_dB = svf->res_dB,
|
|
svf->last_dist = svf->dist;
|
|
|
|
res = pow(10.0, (svf->res_dB - 96.0) / 20.0);
|
|
fr = 2.0 * (double)svf->freq / (double)playback_rate;
|
|
q = 1.0 - fr;
|
|
p = fr + 0.8 * fr * q;
|
|
f = p + p - 1.0;
|
|
q = res * (1.0 + 0.5 * q * (1.0 - q + 5.6 * q * q));
|
|
svf->f = f;
|
|
svf->p = p;
|
|
svf->q = q;
|
|
svf->d = 1.0 + svf->dist;
|
|
}
|
|
}
|
|
|
|
void Reverb::do_filter_moog_dist(double *stream, double *high, double *band, double f, double p, double q, double d,
|
|
double *b0, double *b1, double *b2, double *b3, double *b4)
|
|
{
|
|
double t1, t2, in, tb0 = *b0, tb1 = *b1, tb2 = *b2, tb3 = *b3, tb4 = *b4;
|
|
in = *stream;
|
|
in -= q * tb4;
|
|
t1 = tb1; tb1 = (in + tb0) * p - tb1 * f;
|
|
t2 = tb2; tb2 = (tb1 + t1) * p - tb2 * f;
|
|
t1 = tb3; tb3 = (tb2 + t2) * p - tb3 * f;
|
|
tb4 = (tb3 + t1) * p - tb4 * f;
|
|
tb4 *= d;
|
|
tb4 = tb4 - tb4 * tb4 * tb4 * 0.166667;
|
|
tb0 = in;
|
|
*stream = tb4;
|
|
*high = in - tb4;
|
|
*band = 3.0 * (tb3 - tb4);
|
|
*b0 = tb0, *b1 = tb1, *b2 = tb2, *b3 = tb3, *b4 = tb4;
|
|
}
|
|
|
|
void Reverb::do_filter_moog_dist_band(double *stream, double f, double p, double q, double d,
|
|
double *b0, double *b1, double *b2, double *b3, double *b4)
|
|
{
|
|
double t1, t2, in, tb0 = *b0, tb1 = *b1, tb2 = *b2, tb3 = *b3, tb4 = *b4;
|
|
in = *stream;
|
|
in -= q * tb4;
|
|
t1 = tb1; tb1 = (in + tb0) * p - tb1 * f;
|
|
t2 = tb2; tb2 = (tb1 + t1) * p - tb2 * f;
|
|
t1 = tb3; tb3 = (tb2 + t2) * p - tb3 * f;
|
|
tb4 = (tb3 + t1) * p - tb4 * f;
|
|
tb4 *= d;
|
|
tb4 = tb4 - tb4 * tb4 * tb4 * 0.166667;
|
|
tb0 = in;
|
|
*stream = 3.0 * (tb3 - tb4);
|
|
*b0 = tb0, *b1 = tb1, *b2 = tb2, *b3 = tb3, *b4 = tb4;
|
|
}
|
|
|
|
void Reverb::init_filter_lpf18(filter_lpf18 *p)
|
|
{
|
|
p->ay1 = p->ay2 = p->aout = p->lastin = 0;
|
|
}
|
|
|
|
/*! calculate LPF18 coefficients */
|
|
void Reverb::calc_filter_lpf18(filter_lpf18 *p)
|
|
{
|
|
double kfcn, kp, kp1, kp1h, kres, value;
|
|
|
|
if(p->freq != p->last_freq || p->dist != p->last_dist
|
|
|| p->res != p->last_res) {
|
|
if(p->last_freq == 0) {init_filter_lpf18(p);}
|
|
p->last_freq = p->freq, p->last_dist = p->dist, p->last_res = p->res;
|
|
|
|
kfcn = 2.0 * (double)p->freq / (double)playback_rate;
|
|
kp = ((-2.7528 * kfcn + 3.0429) * kfcn + 1.718) * kfcn - 0.9984;
|
|
kp1 = kp + 1.0;
|
|
kp1h = 0.5 * kp1;
|
|
kres = p->res * (((-2.7079 * kp1 + 10.963) * kp1 - 14.934) * kp1 + 8.4974);
|
|
value = 1.0 + (p->dist * (1.5 + 2.0 * kres * (1.0 - kfcn)));
|
|
|
|
p->kp = kp, p->kp1h = kp1h, p->kres = kres, p->value = value;
|
|
}
|
|
}
|
|
|
|
void Reverb::do_filter_lpf18(double *stream, double *ay1, double *ay2, double *aout, double *lastin,
|
|
double kres, double value, double kp, double kp1h)
|
|
{
|
|
double ax1, ay11, ay31;
|
|
ax1 = *lastin;
|
|
ay11 = *ay1;
|
|
ay31 = *ay2;
|
|
*lastin = *stream - tanh(kres * *aout);
|
|
*ay1 = kp1h * (*lastin + ax1) - kp * *ay1;
|
|
*ay2 = kp1h * (*ay1 + ay11) - kp * *ay2;
|
|
*aout = kp1h * (*ay2 + ay31) - kp * *aout;
|
|
*stream = tanh(*aout * value);
|
|
}
|
|
|
|
#define WS_AMP_MAX ((int32_t) 0x0fffffff)
|
|
#define WS_AMP_MIN ((int32_t)-0x0fffffff)
|
|
|
|
void Reverb::do_hard_clipping(int32_t *stream, int32_t d)
|
|
{
|
|
int32_t x;
|
|
x = imuldiv24(*stream, d);
|
|
x = (x > WS_AMP_MAX) ? WS_AMP_MAX
|
|
: (x < WS_AMP_MIN) ? WS_AMP_MIN : x;
|
|
*stream = x;
|
|
}
|
|
|
|
void Reverb::do_soft_clipping1(int32_t *stream, int32_t d)
|
|
{
|
|
int32_t x, ai = TIM_FSCALE(1.5, 24), bi = TIM_FSCALE(0.5, 24);
|
|
x = imuldiv24(*stream, d);
|
|
x = (x > WS_AMP_MAX) ? WS_AMP_MAX
|
|
: (x < WS_AMP_MIN) ? WS_AMP_MIN : x;
|
|
x = imuldiv24(x, ai) - imuldiv24(imuldiv28(imuldiv28(x, x), x), bi);
|
|
*stream = x;
|
|
}
|
|
|
|
void Reverb::do_soft_clipping2(int32_t *stream, int32_t d)
|
|
{
|
|
int32_t x;
|
|
x = imuldiv24(*stream, d);
|
|
x = (x > WS_AMP_MAX) ? WS_AMP_MAX
|
|
: (x < WS_AMP_MIN) ? WS_AMP_MIN : x;
|
|
x = signlong(x) * ((abs(x) << 1) - imuldiv28(x, x));
|
|
*stream = x;
|
|
}
|
|
|
|
/*! 1st order lowpass filter */
|
|
void Reverb::init_filter_lowpass1(filter_lowpass1 *p)
|
|
{
|
|
if (p->a > 1.0) {p->a = 1.0;}
|
|
p->x1l = p->x1r = 0;
|
|
p->ai = TIM_FSCALE(p->a, 24);
|
|
p->iai = TIM_FSCALE(1.0 - p->a, 24);
|
|
}
|
|
|
|
void Reverb::do_filter_lowpass1(int32_t *stream, int32_t *x1, int32_t a, int32_t ia)
|
|
{
|
|
*stream = *x1 = imuldiv24(*x1, ia) + imuldiv24(*stream, a);
|
|
}
|
|
|
|
void Reverb::do_filter_lowpass1_stereo(int32_t *buf, int32_t count, filter_lowpass1 *p)
|
|
{
|
|
int32_t i, a = p->ai, ia = p->iai, x1l = p->x1l, x1r = p->x1r;
|
|
|
|
for(i = 0; i < count; i++) {
|
|
do_filter_lowpass1(&buf[i], &x1l, a, ia);
|
|
++i;
|
|
do_filter_lowpass1(&buf[i], &x1r, a, ia);
|
|
}
|
|
p->x1l = x1l, p->x1r = x1r;
|
|
}
|
|
|
|
void Reverb::init_filter_biquad(filter_biquad *p)
|
|
{
|
|
p->x1l = 0, p->x2l = 0, p->y1l = 0, p->y2l = 0, p->x1r = 0,
|
|
p->x2r = 0, p->y1r = 0, p->y2r = 0;
|
|
}
|
|
|
|
/*! biquad lowpass filter */
|
|
void Reverb::calc_filter_biquad_low(filter_biquad *p)
|
|
{
|
|
double a0, a1, a2, b1, b02, omega, sn, cs, alpha;
|
|
|
|
if(p->freq != p->last_freq || p->q != p->last_q) {
|
|
if (p->last_freq == 0) {init_filter_biquad(p);}
|
|
p->last_freq = p->freq, p->last_q = p->q;
|
|
omega = 2.0 * M_PI * (double)p->freq / (double)playback_rate;
|
|
sn = sin(omega);
|
|
cs = cos(omega);
|
|
if (p->q == 0 || p->freq < 0 || p->freq > playback_rate / 2) {
|
|
p->b02 = TIM_FSCALE(1.0, 24);
|
|
p->a1 = p->a2 = p->b1 = 0;
|
|
return;
|
|
} else {alpha = sn / (2.0 * p->q);}
|
|
|
|
a0 = 1.0 / (1.0 + alpha);
|
|
b02 = ((1.0 - cs) / 2.0) * a0;
|
|
b1 = (1.0 - cs) * a0;
|
|
a1 = (-2.0 * cs) * a0;
|
|
a2 = (1.0 - alpha) * a0;
|
|
|
|
p->b1 = TIM_FSCALE(b1, 24);
|
|
p->a2 = TIM_FSCALE(a2, 24);
|
|
p->a1 = TIM_FSCALE(a1, 24);
|
|
p->b02 = TIM_FSCALE(b02, 24);
|
|
}
|
|
}
|
|
|
|
/*! biquad highpass filter */
|
|
void Reverb::calc_filter_biquad_high(filter_biquad *p)
|
|
{
|
|
double a0, a1, a2, b1, b02, omega, sn, cs, alpha;
|
|
|
|
if(p->freq != p->last_freq || p->q != p->last_q) {
|
|
if (p->last_freq == 0) {init_filter_biquad(p);}
|
|
p->last_freq = p->freq, p->last_q = p->q;
|
|
omega = 2.0 * M_PI * (double)p->freq / (double)playback_rate;
|
|
sn = sin(omega);
|
|
cs = cos(omega);
|
|
if (p->q == 0 || p->freq < 0 || p->freq > playback_rate / 2) {
|
|
p->b02 = TIM_FSCALE(1.0, 24);
|
|
p->a1 = p->a2 = p->b1 = 0;
|
|
return;
|
|
} else {alpha = sn / (2.0 * p->q);}
|
|
|
|
a0 = 1.0 / (1.0 + alpha);
|
|
b02 = ((1.0 + cs) / 2.0) * a0;
|
|
b1 = (-(1.0 + cs)) * a0;
|
|
a1 = (-2.0 * cs) * a0;
|
|
a2 = (1.0 - alpha) * a0;
|
|
|
|
p->b1 = TIM_FSCALE(b1, 24);
|
|
p->a2 = TIM_FSCALE(a2, 24);
|
|
p->a1 = TIM_FSCALE(a1, 24);
|
|
p->b02 = TIM_FSCALE(b02, 24);
|
|
}
|
|
}
|
|
|
|
void Reverb::do_filter_biquad(int32_t *stream, int32_t a1, int32_t a2, int32_t b1,
|
|
int32_t b02, int32_t *x1, int32_t *x2, int32_t *y1, int32_t *y2)
|
|
{
|
|
int32_t t1;
|
|
t1 = imuldiv24(*stream + *x2, b02) + imuldiv24(*x1, b1) - imuldiv24(*y1, a1) - imuldiv24(*y2, a2);
|
|
*x2 = *x1;
|
|
*x1 = *stream;
|
|
*y2 = *y1;
|
|
*y1 = t1;
|
|
*stream = t1;
|
|
}
|
|
|
|
void Reverb::init_filter_shelving(filter_shelving *p)
|
|
{
|
|
p->x1l = 0, p->x2l = 0, p->y1l = 0, p->y2l = 0, p->x1r = 0,
|
|
p->x2r = 0, p->y1r = 0, p->y2r = 0;
|
|
}
|
|
|
|
/*! shelving filter */
|
|
void Reverb::calc_filter_shelving_low(filter_shelving *p)
|
|
{
|
|
double a0, a1, a2, b0, b1, b2, omega, sn, cs, A, beta;
|
|
|
|
init_filter_shelving(p);
|
|
|
|
A = pow(10, p->gain / 40);
|
|
omega = 2.0 * M_PI * (double)p->freq / (double)playback_rate;
|
|
sn = sin(omega);
|
|
cs = cos(omega);
|
|
if (p->freq < 0 || p->freq > playback_rate / 2) {
|
|
p->b0 = TIM_FSCALE(1.0, 24);
|
|
p->a1 = p->b1 = p->a2 = p->b2 = 0;
|
|
return;
|
|
}
|
|
if (p->q == 0) {beta = sqrt(A + A);}
|
|
else {beta = sqrt(A) / p->q;}
|
|
|
|
a0 = 1.0 / ((A + 1) + (A - 1) * cs + beta * sn);
|
|
a1 = 2.0 * ((A - 1) + (A + 1) * cs);
|
|
a2 = -((A + 1) + (A - 1) * cs - beta * sn);
|
|
b0 = A * ((A + 1) - (A - 1) * cs + beta * sn);
|
|
b1 = 2.0 * A * ((A - 1) - (A + 1) * cs);
|
|
b2 = A * ((A + 1) - (A - 1) * cs - beta * sn);
|
|
|
|
a1 *= a0;
|
|
a2 *= a0;
|
|
b1 *= a0;
|
|
b2 *= a0;
|
|
b0 *= a0;
|
|
|
|
p->a1 = TIM_FSCALE(a1, 24);
|
|
p->a2 = TIM_FSCALE(a2, 24);
|
|
p->b0 = TIM_FSCALE(b0, 24);
|
|
p->b1 = TIM_FSCALE(b1, 24);
|
|
p->b2 = TIM_FSCALE(b2, 24);
|
|
}
|
|
|
|
void Reverb::calc_filter_shelving_high(filter_shelving *p)
|
|
{
|
|
double a0, a1, a2, b0, b1, b2, omega, sn, cs, A, beta;
|
|
|
|
init_filter_shelving(p);
|
|
|
|
A = pow(10, p->gain / 40);
|
|
omega = 2.0 * M_PI * (double)p->freq / (double)playback_rate;
|
|
sn = sin(omega);
|
|
cs = cos(omega);
|
|
if (p->freq < 0 || p->freq > playback_rate / 2) {
|
|
p->b0 = TIM_FSCALE(1.0, 24);
|
|
p->a1 = p->b1 = p->a2 = p->b2 = 0;
|
|
return;
|
|
}
|
|
if (p->q == 0) {beta = sqrt(A + A);}
|
|
else {beta = sqrt(A) / p->q;}
|
|
|
|
a0 = 1.0 / ((A + 1) - (A - 1) * cs + beta * sn);
|
|
a1 = (-2 * ((A - 1) - (A + 1) * cs));
|
|
a2 = -((A + 1) - (A - 1) * cs - beta * sn);
|
|
b0 = A * ((A + 1) + (A - 1) * cs + beta * sn);
|
|
b1 = -2 * A * ((A - 1) + (A + 1) * cs);
|
|
b2 = A * ((A + 1) + (A - 1) * cs - beta * sn);
|
|
|
|
a1 *= a0;
|
|
a2 *= a0;
|
|
b0 *= a0;
|
|
b1 *= a0;
|
|
b2 *= a0;
|
|
|
|
p->a1 = TIM_FSCALE(a1, 24);
|
|
p->a2 = TIM_FSCALE(a2, 24);
|
|
p->b0 = TIM_FSCALE(b0, 24);
|
|
p->b1 = TIM_FSCALE(b1, 24);
|
|
p->b2 = TIM_FSCALE(b2, 24);
|
|
}
|
|
|
|
void Reverb::do_shelving_filter_stereo(int32_t* buf, int32_t count, filter_shelving *p)
|
|
{
|
|
int32_t i;
|
|
int32_t x1l = p->x1l, x2l = p->x2l, y1l = p->y1l, y2l = p->y2l,
|
|
x1r = p->x1r, x2r = p->x2r, y1r = p->y1r, y2r = p->y2r, yout;
|
|
int32_t a1 = p->a1, a2 = p->a2, b0 = p->b0, b1 = p->b1, b2 = p->b2;
|
|
|
|
for(i = 0; i < count; i++) {
|
|
yout = imuldiv24(buf[i], b0) + imuldiv24(x1l, b1) + imuldiv24(x2l, b2) + imuldiv24(y1l, a1) + imuldiv24(y2l, a2);
|
|
x2l = x1l;
|
|
x1l = buf[i];
|
|
y2l = y1l;
|
|
y1l = yout;
|
|
buf[i] = yout;
|
|
|
|
yout = imuldiv24(buf[++i], b0) + imuldiv24(x1r, b1) + imuldiv24(x2r, b2) + imuldiv24(y1r, a1) + imuldiv24(y2r, a2);
|
|
x2r = x1r;
|
|
x1r = buf[i];
|
|
y2r = y1r;
|
|
y1r = yout;
|
|
buf[i] = yout;
|
|
}
|
|
p->x1l = x1l, p->x2l = x2l, p->y1l = y1l, p->y2l = y2l,
|
|
p->x1r = x1r, p->x2r = x2r, p->y1r = y1r, p->y2r = y2r;
|
|
}
|
|
|
|
void Reverb::init_filter_peaking(filter_peaking *p)
|
|
{
|
|
p->x1l = 0, p->x2l = 0, p->y1l = 0, p->y2l = 0, p->x1r = 0,
|
|
p->x2r = 0, p->y1r = 0, p->y2r = 0;
|
|
}
|
|
|
|
/*! peaking filter */
|
|
void Reverb::calc_filter_peaking(filter_peaking *p)
|
|
{
|
|
double a0, ba1, a2, b0, b2, omega, sn, cs, A, alpha;
|
|
|
|
init_filter_peaking(p);
|
|
|
|
A = pow(10, p->gain / 40);
|
|
omega = 2.0 * M_PI * (double)p->freq / (double)playback_rate;
|
|
sn = sin(omega);
|
|
cs = cos(omega);
|
|
if (p->q == 0 || p->freq < 0 || p->freq > playback_rate / 2) {
|
|
p->b0 = TIM_FSCALE(1.0, 24);
|
|
p->ba1 = p->a2 = p->b2 = 0;
|
|
return;
|
|
} else {alpha = sn / (2.0 * p->q);}
|
|
|
|
a0 = 1.0 / (1.0 + alpha / A);
|
|
ba1 = -2.0 * cs;
|
|
a2 = 1.0 - alpha / A;
|
|
b0 = 1.0 + alpha * A;
|
|
b2 = 1.0 - alpha * A;
|
|
|
|
ba1 *= a0;
|
|
a2 *= a0;
|
|
b0 *= a0;
|
|
b2 *= a0;
|
|
|
|
p->ba1 = TIM_FSCALE(ba1, 24);
|
|
p->a2 = TIM_FSCALE(a2, 24);
|
|
p->b0 = TIM_FSCALE(b0, 24);
|
|
p->b2 = TIM_FSCALE(b2, 24);
|
|
}
|
|
|
|
void Reverb::do_peaking_filter_stereo(int32_t* buf, int32_t count, filter_peaking *p)
|
|
{
|
|
int32_t i;
|
|
int32_t x1l = p->x1l, x2l = p->x2l, y1l = p->y1l, y2l = p->y2l,
|
|
x1r = p->x1r, x2r = p->x2r, y1r = p->y1r, y2r = p->y2r, yout;
|
|
int32_t ba1 = p->ba1, a2 = p->a2, b0 = p->b0, b2 = p->b2;
|
|
|
|
for(i = 0; i < count; i++) {
|
|
yout = imuldiv24(buf[i], b0) + imuldiv24(x1l - y1l, ba1) + imuldiv24(x2l, b2) - imuldiv24(y2l, a2);
|
|
x2l = x1l;
|
|
x1l = buf[i];
|
|
y2l = y1l;
|
|
y1l = yout;
|
|
buf[i] = yout;
|
|
|
|
yout = imuldiv24(buf[++i], b0) + imuldiv24(x1r - y1r, ba1) + imuldiv24(x2r, b2) - imuldiv24(y2r, a2);
|
|
x2r = x1r;
|
|
x1r = buf[i];
|
|
y2r = y1r;
|
|
y1r = yout;
|
|
buf[i] = yout;
|
|
}
|
|
p->x1l = x1l, p->x2l = x2l, p->y1l = y1l, p->y2l = y2l,
|
|
p->x1r = x1r, p->x2r = x2r, p->y1r = y1r, p->y2r = y2r;
|
|
}
|
|
|
|
void Reverb::init_pink_noise(pink_noise *p)
|
|
{
|
|
p->b0 = p->b1 = p->b2 = p->b3 = p->b4 = p->b5 = p->b6 = 0;
|
|
}
|
|
|
|
float Reverb::get_pink_noise(pink_noise *p)
|
|
{
|
|
float b0 = p->b0, b1 = p->b1, b2 = p->b2, b3 = p->b3,
|
|
b4 = p->b4, b5 = p->b5, b6 = p->b6, pink, white;
|
|
|
|
white = (float)flt_rand() * 2.0 - 1.0;
|
|
b0 = 0.99886 * b0 + white * 0.0555179;
|
|
b1 = 0.99332 * b1 + white * 0.0750759;
|
|
b2 = 0.96900 * b2 + white * 0.1538520;
|
|
b3 = 0.86650 * b3 + white * 0.3104856;
|
|
b4 = 0.55000 * b4 + white * 0.5329522;
|
|
b5 = -0.7616 * b5 - white * 0.0168980;
|
|
pink = b0 + b1 + b2 + b3 + b4 + b5 + b6 + white * 0.5362;
|
|
b6 = white * 0.115926;
|
|
pink *= 0.22f;
|
|
pink = (pink > 1.0) ? 1.0 : (pink < -1.0) ? -1.0 : pink;
|
|
|
|
p->b0 = b0, p->b1 = b1, p->b2 = b2, p->b3 = b3,
|
|
p->b4 = b4, p->b5 = b5, p->b6 = b6;
|
|
|
|
return pink;
|
|
}
|
|
|
|
float Reverb::get_pink_noise_light(pink_noise *p)
|
|
{
|
|
float b0 = p->b0, b1 = p->b1, b2 = p->b2, pink, white;
|
|
|
|
white = (float)flt_rand() * 2.0 - 1.0;
|
|
b0 = 0.99765 * b0 + white * 0.0990460;
|
|
b1 = 0.96300 * b1 + white * 0.2965164;
|
|
b2 = 0.57000 * b2 + white * 1.0526913;
|
|
pink = b0 + b1 + b2 + white * 0.1848;
|
|
pink *= 0.22f;
|
|
pink = (pink > 1.0) ? 1.0 : (pink < -1.0) ? -1.0 : pink;
|
|
|
|
p->b0 = b0, p->b1 = b1, p->b2 = b2;
|
|
|
|
return pink;
|
|
}
|
|
|
|
/* */
|
|
/* Standard Reverb Effect */
|
|
/* */
|
|
#define REV_VAL0 5.3
|
|
#define REV_VAL1 10.5
|
|
#define REV_VAL2 44.12
|
|
#define REV_VAL3 21.0
|
|
|
|
|
|
void Reverb::set_ch_reverb(int32_t *sbuffer, int32_t n, int32_t level)
|
|
{
|
|
int32_t i;
|
|
if(!level) {return;}
|
|
double send_level = (double)level / 127.0 * REV_INP_LEV;
|
|
|
|
for(i = 0; i < n; i++)
|
|
{
|
|
reverb_effect_buffer[i] += int32_t(sbuffer[i] * send_level);
|
|
}
|
|
}
|
|
|
|
double Reverb::gs_revchar_to_roomsize(int character)
|
|
{
|
|
double rs;
|
|
switch(character) {
|
|
case 0: rs = 1.0; break; /* Room 1 */
|
|
case 1: rs = 0.94; break; /* Room 2 */
|
|
case 2: rs = 0.97; break; /* Room 3 */
|
|
case 3: rs = 0.90; break; /* Hall 1 */
|
|
case 4: rs = 0.85; break; /* Hall 2 */
|
|
default: rs = 1.0; break; /* Plate, Delay, Panning Delay */
|
|
}
|
|
return rs;
|
|
}
|
|
|
|
double Reverb::gs_revchar_to_level(int character)
|
|
{
|
|
double level;
|
|
switch(character) {
|
|
case 0: level = 0.744025605; break; /* Room 1 */
|
|
case 1: level = 1.224309745; break; /* Room 2 */
|
|
case 2: level = 0.858592403; break; /* Room 3 */
|
|
case 3: level = 1.0471802; break; /* Hall 1 */
|
|
case 4: level = 1.0; break; /* Hall 2 */
|
|
case 5: level = 0.865335496; break; /* Plate */
|
|
default: level = 1.0; break; /* Delay, Panning Delay */
|
|
}
|
|
return level;
|
|
}
|
|
|
|
double Reverb::gs_revchar_to_rt(int character)
|
|
{
|
|
double rt;
|
|
switch(character) {
|
|
case 0: rt = 0.516850262; break; /* Room 1 */
|
|
case 1: rt = 1.004226004; break; /* Room 2 */
|
|
case 2: rt = 0.691046825; break; /* Room 3 */
|
|
case 3: rt = 0.893006004; break; /* Hall 1 */
|
|
case 4: rt = 1.0; break; /* Hall 2 */
|
|
case 5: rt = 0.538476488; break; /* Plate */
|
|
default: rt = 1.0; break; /* Delay, Panning Delay */
|
|
}
|
|
return rt;
|
|
}
|
|
|
|
void Reverb::init_standard_reverb(InfoStandardReverb *info)
|
|
{
|
|
double time;
|
|
info->ta = info->tb = 0;
|
|
info->HPFL = info->HPFR = info->LPFL = info->LPFR = info->EPFL = info->EPFR = 0;
|
|
info->spt0 = info->spt1 = info->spt2 = info->spt3 = 0;
|
|
time = reverb_time_table[reverb_status_gs.time] * gs_revchar_to_rt(reverb_status_gs.character)
|
|
/ reverb_time_table[64] * 0.8;
|
|
info->rpt0 = REV_VAL0 * playback_rate / 1000.0 * time;
|
|
info->rpt1 = REV_VAL1 * playback_rate / 1000.0 * time;
|
|
info->rpt2 = REV_VAL2 * playback_rate / 1000.0 * time;
|
|
info->rpt3 = REV_VAL3 * playback_rate / 1000.0 * time;
|
|
while (!isprime(info->rpt0)) {info->rpt0++;}
|
|
while (!isprime(info->rpt1)) {info->rpt1++;}
|
|
while (!isprime(info->rpt2)) {info->rpt2++;}
|
|
while (!isprime(info->rpt3)) {info->rpt3++;}
|
|
set_delay(&(info->buf0_L), info->rpt0 + 1);
|
|
set_delay(&(info->buf0_R), info->rpt0 + 1);
|
|
set_delay(&(info->buf1_L), info->rpt1 + 1);
|
|
set_delay(&(info->buf1_R), info->rpt1 + 1);
|
|
set_delay(&(info->buf2_L), info->rpt2 + 1);
|
|
set_delay(&(info->buf2_R), info->rpt2 + 1);
|
|
set_delay(&(info->buf3_L), info->rpt3 + 1);
|
|
set_delay(&(info->buf3_R), info->rpt3 + 1);
|
|
info->fbklev = 0.12;
|
|
info->nmixlev = 0.7;
|
|
info->cmixlev = 0.9;
|
|
info->monolev = 0.7;
|
|
info->hpflev = 0.5;
|
|
info->lpflev = 0.45;
|
|
info->lpfinp = 0.55;
|
|
info->epflev = 0.4;
|
|
info->epfinp = 0.48;
|
|
info->width = 0.125;
|
|
info->wet = 2.0 * (double)reverb_status_gs.level / 127.0 * gs_revchar_to_level(reverb_status_gs.character);
|
|
info->fbklevi = TIM_FSCALE(info->fbklev, 24);
|
|
info->nmixlevi = TIM_FSCALE(info->nmixlev, 24);
|
|
info->cmixlevi = TIM_FSCALE(info->cmixlev, 24);
|
|
info->monolevi = TIM_FSCALE(info->monolev, 24);
|
|
info->hpflevi = TIM_FSCALE(info->hpflev, 24);
|
|
info->lpflevi = TIM_FSCALE(info->lpflev, 24);
|
|
info->lpfinpi = TIM_FSCALE(info->lpfinp, 24);
|
|
info->epflevi = TIM_FSCALE(info->epflev, 24);
|
|
info->epfinpi = TIM_FSCALE(info->epfinp, 24);
|
|
info->widthi = TIM_FSCALE(info->width, 24);
|
|
info->weti = TIM_FSCALE(info->wet, 24);
|
|
}
|
|
|
|
void Reverb::free_standard_reverb(InfoStandardReverb *info)
|
|
{
|
|
free_delay(&(info->buf0_L));
|
|
free_delay(&(info->buf0_R));
|
|
free_delay(&(info->buf1_L));
|
|
free_delay(&(info->buf1_R));
|
|
free_delay(&(info->buf2_L));
|
|
free_delay(&(info->buf2_R));
|
|
free_delay(&(info->buf3_L));
|
|
free_delay(&(info->buf3_R));
|
|
}
|
|
|
|
/*! Standard Reverberator; this implementation is specialized for system effect. */
|
|
void Reverb::do_ch_standard_reverb(int32_t *buf, int32_t count, InfoStandardReverb *info)
|
|
{
|
|
int32_t i, fixp, s, t;
|
|
int32_t spt0 = info->spt0, spt1 = info->spt1, spt2 = info->spt2, spt3 = info->spt3,
|
|
ta = info->ta, tb = info->tb, HPFL = info->HPFL, HPFR = info->HPFR,
|
|
LPFL = info->LPFL, LPFR = info->LPFR, EPFL = info->EPFL, EPFR = info->EPFR;
|
|
int32_t *buf0_L = info->buf0_L.buf, *buf0_R = info->buf0_R.buf,
|
|
*buf1_L = info->buf1_L.buf, *buf1_R = info->buf1_R.buf,
|
|
*buf2_L = info->buf2_L.buf, *buf2_R = info->buf2_R.buf,
|
|
*buf3_L = info->buf3_L.buf, *buf3_R = info->buf3_R.buf;
|
|
double fbklev = info->fbklev, cmixlev = info->cmixlev,
|
|
hpflev = info->hpflev, lpflev = info->lpflev, lpfinp = info->lpfinp,
|
|
epflev = info->epflev, epfinp = info->epfinp, width = info->width,
|
|
rpt0 = info->rpt0, rpt1 = info->rpt1, rpt2 = info->rpt2, rpt3 = info->rpt3, wet = info->wet;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_standard_reverb(info);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_standard_reverb(info);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
/* L */
|
|
fixp = reverb_effect_buffer[i];
|
|
|
|
LPFL = LPFL * lpflev + (buf2_L[spt2] + tb) * lpfinp + ta * width;
|
|
ta = buf3_L[spt3];
|
|
s = buf3_L[spt3] = buf0_L[spt0];
|
|
buf0_L[spt0] = -LPFL;
|
|
|
|
t = (HPFL + fixp) * hpflev;
|
|
HPFL = t - fixp;
|
|
|
|
buf2_L[spt2] = (s - fixp * fbklev) * cmixlev;
|
|
tb = buf1_L[spt1];
|
|
buf1_L[spt1] = t;
|
|
|
|
EPFL = EPFL * epflev + ta * epfinp;
|
|
buf[i] += int32_t((ta + EPFL) * wet);
|
|
|
|
/* R */
|
|
fixp = reverb_effect_buffer[++i];
|
|
|
|
LPFR = LPFR * lpflev + (buf2_R[spt2] + tb) * lpfinp + ta * width;
|
|
ta = buf3_R[spt3];
|
|
s = buf3_R[spt3] = buf0_R[spt0];
|
|
buf0_R[spt0] = LPFR;
|
|
|
|
t = (HPFR + fixp) * hpflev;
|
|
HPFR = t - fixp;
|
|
|
|
buf2_R[spt2] = (s - fixp * fbklev) * cmixlev;
|
|
tb = buf1_R[spt1];
|
|
buf1_R[spt1] = t;
|
|
|
|
EPFR = EPFR * epflev + ta * epfinp;
|
|
buf[i] += int32_t((ta + EPFR) * wet);
|
|
|
|
if (++spt0 == rpt0) {spt0 = 0;}
|
|
if (++spt1 == rpt1) {spt1 = 0;}
|
|
if (++spt2 == rpt2) {spt2 = 0;}
|
|
if (++spt3 == rpt3) {spt3 = 0;}
|
|
}
|
|
memset(reverb_effect_buffer, 0, sizeof(int32_t) * count);
|
|
info->spt0 = spt0, info->spt1 = spt1, info->spt2 = spt2, info->spt3 = spt3,
|
|
info->ta = ta, info->tb = tb, info->HPFL = HPFL, info->HPFR = HPFR,
|
|
info->LPFL = LPFL, info->LPFR = LPFR, info->EPFL = EPFL, info->EPFR = EPFR;
|
|
}
|
|
|
|
/*! Standard Monoral Reverberator; this implementation is specialized for system effect. */
|
|
void Reverb::do_ch_standard_reverb_mono(int32_t *buf, int32_t count, InfoStandardReverb *info)
|
|
{
|
|
int32_t i, fixp, s, t;
|
|
int32_t spt0 = info->spt0, spt1 = info->spt1, spt2 = info->spt2, spt3 = info->spt3,
|
|
ta = info->ta, tb = info->tb, HPFL = info->HPFL, HPFR = info->HPFR,
|
|
LPFL = info->LPFL, LPFR = info->LPFR, EPFL = info->EPFL, EPFR = info->EPFR;
|
|
int32_t *buf0_L = info->buf0_L.buf, *buf0_R = info->buf0_R.buf,
|
|
*buf1_L = info->buf1_L.buf, *buf1_R = info->buf1_R.buf,
|
|
*buf2_L = info->buf2_L.buf, *buf2_R = info->buf2_R.buf,
|
|
*buf3_L = info->buf3_L.buf, *buf3_R = info->buf3_R.buf;
|
|
double fbklev = info->fbklev, nmixlev = info->nmixlev, monolev = info->monolev,
|
|
hpflev = info->hpflev, lpflev = info->lpflev, lpfinp = info->lpfinp,
|
|
epflev = info->epflev, epfinp = info->epfinp, width = info->width,
|
|
rpt0 = info->rpt0, rpt1 = info->rpt1, rpt2 = info->rpt2, rpt3 = info->rpt3, wet = info->wet;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_standard_reverb(info);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_standard_reverb(info);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
/* L */
|
|
fixp = buf[i] * monolev;
|
|
|
|
LPFL = LPFL * lpflev + (buf2_L[spt2] + tb) * lpfinp + ta * width;
|
|
ta = buf3_L[spt3];
|
|
s = buf3_L[spt3] = buf0_L[spt0];
|
|
buf0_L[spt0] = -LPFL;
|
|
|
|
t = (HPFL + fixp) * hpflev;
|
|
HPFL = t - fixp;
|
|
|
|
buf2_L[spt2] = (s - fixp * fbklev) * nmixlev;
|
|
tb = buf1_L[spt1];
|
|
buf1_L[spt1] = t;
|
|
|
|
/* R */
|
|
LPFR = LPFR * lpflev + (buf2_R[spt2] + tb) * lpfinp + ta * width;
|
|
ta = buf3_R[spt3];
|
|
s = buf3_R[spt3] = buf0_R[spt0];
|
|
buf0_R[spt0] = LPFR;
|
|
|
|
t = (HPFR + fixp) * hpflev;
|
|
HPFR = t - fixp;
|
|
|
|
buf2_R[spt2] = (s - fixp * fbklev) * nmixlev;
|
|
tb = buf1_R[spt1];
|
|
buf1_R[spt1] = t;
|
|
|
|
EPFR = EPFR * epflev + ta * epfinp;
|
|
buf[i] = (ta + EPFR) * wet + fixp;
|
|
|
|
if (++spt0 == rpt0) {spt0 = 0;}
|
|
if (++spt1 == rpt1) {spt1 = 0;}
|
|
if (++spt2 == rpt2) {spt2 = 0;}
|
|
if (++spt3 == rpt3) {spt3 = 0;}
|
|
}
|
|
memset(reverb_effect_buffer, 0, sizeof(int32_t) * count);
|
|
info->spt0 = spt0, info->spt1 = spt1, info->spt2 = spt2, info->spt3 = spt3,
|
|
info->ta = ta, info->tb = tb, info->HPFL = HPFL, info->HPFR = HPFR,
|
|
info->LPFL = LPFL, info->LPFR = LPFR, info->EPFL = EPFL, info->EPFR = EPFR;
|
|
}
|
|
|
|
/* */
|
|
/* Freeverb */
|
|
/* */
|
|
void Reverb::set_freeverb_allpass(allpass *allpass, int32_t size)
|
|
{
|
|
if(allpass->buf != NULL) {
|
|
free(allpass->buf);
|
|
allpass->buf = NULL;
|
|
}
|
|
allpass->buf = (int32_t *)safe_malloc(sizeof(int32_t) * size);
|
|
if(allpass->buf == NULL) {return;}
|
|
allpass->index = 0;
|
|
allpass->size = size;
|
|
}
|
|
|
|
void Reverb::init_freeverb_allpass(allpass *allpass)
|
|
{
|
|
memset(allpass->buf, 0, sizeof(int32_t) * allpass->size);
|
|
}
|
|
|
|
void Reverb::set_freeverb_comb(comb *comb, int32_t size)
|
|
{
|
|
if(comb->buf != NULL) {
|
|
free(comb->buf);
|
|
comb->buf = NULL;
|
|
}
|
|
comb->buf = (int32_t *)safe_malloc(sizeof(int32_t) * size);
|
|
if(comb->buf == NULL) {return;}
|
|
comb->index = 0;
|
|
comb->size = size;
|
|
comb->filterstore = 0;
|
|
}
|
|
|
|
void Reverb::init_freeverb_comb(comb *comb)
|
|
{
|
|
memset(comb->buf, 0, sizeof(int32_t) * comb->size);
|
|
}
|
|
|
|
#define scalewet 0.06
|
|
#define scaledamp 0.4
|
|
#define initialroom 0.5
|
|
#define initialdamp 0.5
|
|
#define initialwet 1 / scalewet
|
|
#define initialdry 0
|
|
#define initialwidth 0.5
|
|
#define initialallpassfbk 0.65
|
|
#define stereospread 23
|
|
static const int combtunings[numcombs] = {1116, 1188, 1277, 1356, 1422, 1491, 1557, 1617};
|
|
static const int allpasstunings[numallpasses] = {225, 341, 441, 556};
|
|
#define fixedgain 0.025
|
|
#define combfbk 3.0
|
|
|
|
void Reverb::realloc_freeverb_buf(InfoFreeverb *rev)
|
|
{
|
|
int i;
|
|
int32_t tmpL, tmpR;
|
|
double time, samplerate = playback_rate;
|
|
|
|
time = reverb_time_table[reverb_status_gs.time] * gs_revchar_to_rt(reverb_status_gs.character) * combfbk
|
|
/ (60 * combtunings[numcombs - 1] / (-20 * log10(rev->roomsize1) * 44100.0));
|
|
|
|
for(i = 0; i < numcombs; i++)
|
|
{
|
|
tmpL = combtunings[i] * samplerate * time / 44100.0;
|
|
tmpR = (combtunings[i] + stereospread) * samplerate * time / 44100.0;
|
|
if(tmpL < 10) tmpL = 10;
|
|
if(tmpR < 10) tmpR = 10;
|
|
while(!isprime(tmpL)) tmpL++;
|
|
while(!isprime(tmpR)) tmpR++;
|
|
rev->combL[i].size = tmpL;
|
|
rev->combR[i].size = tmpR;
|
|
set_freeverb_comb(&rev->combL[i], rev->combL[i].size);
|
|
set_freeverb_comb(&rev->combR[i], rev->combR[i].size);
|
|
}
|
|
|
|
for(i = 0; i < numallpasses; i++)
|
|
{
|
|
tmpL = allpasstunings[i] * samplerate * time / 44100.0;
|
|
tmpR = (allpasstunings[i] + stereospread) * samplerate * time / 44100.0;
|
|
if(tmpL < 10) tmpL = 10;
|
|
if(tmpR < 10) tmpR = 10;
|
|
while(!isprime(tmpL)) tmpL++;
|
|
while(!isprime(tmpR)) tmpR++;
|
|
rev->allpassL[i].size = tmpL;
|
|
rev->allpassR[i].size = tmpR;
|
|
set_freeverb_allpass(&rev->allpassL[i], rev->allpassL[i].size);
|
|
set_freeverb_allpass(&rev->allpassR[i], rev->allpassR[i].size);
|
|
}
|
|
}
|
|
|
|
void Reverb::update_freeverb(InfoFreeverb *rev)
|
|
{
|
|
int i;
|
|
double allpassfbk = 0.55, rtbase, rt;
|
|
|
|
rev->wet = (double)reverb_status_gs.level / 127.0 * gs_revchar_to_level(reverb_status_gs.character) * fixedgain;
|
|
rev->roomsize = gs_revchar_to_roomsize(reverb_status_gs.character) * freeverb_scaleroom + freeverb_offsetroom;
|
|
rev->width = 0.5;
|
|
|
|
rev->wet1 = rev->width / 2.0 + 0.5;
|
|
rev->wet2 = (1.0 - rev->width) / 2.0;
|
|
rev->roomsize1 = rev->roomsize;
|
|
rev->damp1 = rev->damp;
|
|
|
|
realloc_freeverb_buf(rev);
|
|
|
|
rtbase = 1.0 / (44100.0 * reverb_time_table[reverb_status_gs.time] * gs_revchar_to_rt(reverb_status_gs.character));
|
|
|
|
for(i = 0; i < numcombs; i++)
|
|
{
|
|
rt = pow(10.0, -combfbk * (double)combtunings[i] * rtbase);
|
|
rev->combL[i].feedback = rt;
|
|
rev->combR[i].feedback = rt;
|
|
rev->combL[i].damp1 = rev->damp1;
|
|
rev->combR[i].damp1 = rev->damp1;
|
|
rev->combL[i].damp2 = 1 - rev->damp1;
|
|
rev->combR[i].damp2 = 1 - rev->damp1;
|
|
rev->combL[i].damp1i = TIM_FSCALE(rev->combL[i].damp1, 24);
|
|
rev->combR[i].damp1i = TIM_FSCALE(rev->combR[i].damp1, 24);
|
|
rev->combL[i].damp2i = TIM_FSCALE(rev->combL[i].damp2, 24);
|
|
rev->combR[i].damp2i = TIM_FSCALE(rev->combR[i].damp2, 24);
|
|
rev->combL[i].feedbacki = TIM_FSCALE(rev->combL[i].feedback, 24);
|
|
rev->combR[i].feedbacki = TIM_FSCALE(rev->combR[i].feedback, 24);
|
|
}
|
|
|
|
for(i = 0; i < numallpasses; i++)
|
|
{
|
|
rev->allpassL[i].feedback = allpassfbk;
|
|
rev->allpassR[i].feedback = allpassfbk;
|
|
rev->allpassL[i].feedbacki = TIM_FSCALE(rev->allpassL[i].feedback, 24);
|
|
rev->allpassR[i].feedbacki = TIM_FSCALE(rev->allpassR[i].feedback, 24);
|
|
}
|
|
|
|
rev->wet1i = TIM_FSCALE(rev->wet1, 24);
|
|
rev->wet2i = TIM_FSCALE(rev->wet2, 24);
|
|
|
|
set_delay(&(rev->pdelay), (int32_t)((double)reverb_status_gs.pre_delay_time * reverb_predelay_factor * playback_rate / 1000.0));
|
|
}
|
|
|
|
void Reverb::init_freeverb(InfoFreeverb *rev)
|
|
{
|
|
int i;
|
|
for(i = 0; i < numcombs; i++) {
|
|
init_freeverb_comb(&rev->combL[i]);
|
|
init_freeverb_comb(&rev->combR[i]);
|
|
}
|
|
for(i = 0; i < numallpasses; i++) {
|
|
init_freeverb_allpass(&rev->allpassL[i]);
|
|
init_freeverb_allpass(&rev->allpassR[i]);
|
|
}
|
|
}
|
|
|
|
void Reverb::alloc_freeverb_buf(InfoFreeverb *rev)
|
|
{
|
|
int i;
|
|
if(rev->alloc_flag) {return;}
|
|
for (i = 0; i < numcombs; i++) {
|
|
set_freeverb_comb(&rev->combL[i], combtunings[i]);
|
|
set_freeverb_comb(&rev->combR[i], combtunings[i] + stereospread);
|
|
}
|
|
for (i = 0; i < numallpasses; i++) {
|
|
set_freeverb_allpass(&rev->allpassL[i], allpasstunings[i]);
|
|
set_freeverb_allpass(&rev->allpassR[i], allpasstunings[i] + stereospread);
|
|
rev->allpassL[i].feedback = initialallpassfbk;
|
|
rev->allpassR[i].feedback = initialallpassfbk;
|
|
}
|
|
|
|
rev->wet = initialwet * scalewet;
|
|
rev->damp = initialdamp * scaledamp;
|
|
rev->width = initialwidth;
|
|
rev->roomsize = initialroom * freeverb_scaleroom + freeverb_offsetroom;
|
|
|
|
rev->alloc_flag = 1;
|
|
}
|
|
|
|
void Reverb::free_freeverb_buf(InfoFreeverb *rev)
|
|
{
|
|
int i;
|
|
|
|
for(i = 0; i < numcombs; i++)
|
|
{
|
|
if(rev->combL[i].buf != NULL) {
|
|
free(rev->combL[i].buf);
|
|
rev->combL[i].buf = NULL;
|
|
}
|
|
if(rev->combR[i].buf != NULL) {
|
|
free(rev->combR[i].buf);
|
|
rev->combR[i].buf = NULL;
|
|
}
|
|
}
|
|
for(i = 0; i < numallpasses; i++)
|
|
{
|
|
if(rev->allpassL[i].buf != NULL) {
|
|
free(rev->allpassL[i].buf);
|
|
rev->allpassL[i].buf = NULL;
|
|
}
|
|
if(rev->allpassR[i].buf != NULL) {
|
|
free(rev->allpassR[i].buf);
|
|
rev->allpassR[i].buf = NULL;
|
|
}
|
|
}
|
|
free_delay(&(rev->pdelay));
|
|
}
|
|
|
|
void Reverb::do_freeverb_allpass(int32_t *stream, int32_t *buf, int32_t size, int32_t *index, int32_t feedback)
|
|
{
|
|
int32_t bufout, output;
|
|
bufout = buf[*index];
|
|
output = -*stream + bufout;
|
|
buf[*index] = *stream + imuldiv24(bufout, feedback);
|
|
if (++*index >= size) {*index = 0;}
|
|
*stream = output;
|
|
}
|
|
|
|
void Reverb::do_freeverb_comb(int32_t input, int32_t *stream, int32_t *buf, int32_t size, int32_t *index,
|
|
int32_t damp1, int32_t damp2, int32_t *fs, int32_t feedback)
|
|
{
|
|
int32_t output;
|
|
output = buf[*index];
|
|
*fs = imuldiv24(output, damp2) + imuldiv24(*fs, damp1);
|
|
buf[*index] = input + imuldiv24(*fs, feedback);
|
|
if (++*index >= size) {*index = 0;}
|
|
*stream += output;
|
|
}
|
|
|
|
void Reverb::do_ch_freeverb(int32_t *buf, int32_t count, InfoFreeverb *rev)
|
|
{
|
|
int32_t i, k = 0;
|
|
int32_t outl, outr, input;
|
|
comb *combL = rev->combL, *combR = rev->combR;
|
|
allpass *allpassL = rev->allpassL, *allpassR = rev->allpassR;
|
|
simple_delay *pdelay = &(rev->pdelay);
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
alloc_freeverb_buf(rev);
|
|
update_freeverb(rev);
|
|
init_freeverb(rev);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_freeverb_buf(rev);
|
|
return;
|
|
}
|
|
|
|
for (k = 0; k < count; k+=2)
|
|
{
|
|
input = reverb_effect_buffer[k] + reverb_effect_buffer[k + 1];
|
|
outl = outr = reverb_effect_buffer[k] = reverb_effect_buffer[k + 1] = 0;
|
|
|
|
do_delay(&input, pdelay->buf, pdelay->size, &pdelay->index);
|
|
|
|
for (i = 0; i < numcombs; i++) {
|
|
do_freeverb_comb(input, &outl, combL[i].buf, combL[i].size, &combL[i].index,
|
|
combL[i].damp1i, combL[i].damp2i, &combL[i].filterstore, combL[i].feedbacki);
|
|
do_freeverb_comb(input, &outr, combR[i].buf, combR[i].size, &combR[i].index,
|
|
combR[i].damp1i, combR[i].damp2i, &combR[i].filterstore, combR[i].feedbacki);
|
|
}
|
|
for (i = 0; i < numallpasses; i++) {
|
|
do_freeverb_allpass(&outl, allpassL[i].buf, allpassL[i].size, &allpassL[i].index, allpassL[i].feedbacki);
|
|
do_freeverb_allpass(&outr, allpassR[i].buf, allpassR[i].size, &allpassR[i].index, allpassR[i].feedbacki);
|
|
}
|
|
buf[k] += imuldiv24(outl, rev->wet1i) + imuldiv24(outr, rev->wet2i);
|
|
buf[k + 1] += imuldiv24(outr, rev->wet1i) + imuldiv24(outl, rev->wet2i);
|
|
}
|
|
}
|
|
|
|
/* */
|
|
/* Reverb: Delay & Panning Delay */
|
|
/* */
|
|
/*! initialize Reverb: Delay Effect; this implementation is specialized for system effect. */
|
|
void Reverb::init_ch_reverb_delay(InfoDelay3 *info)
|
|
{
|
|
int32_t x;
|
|
info->size[0] = (double)reverb_status_gs.time * 3.75 * playback_rate / 1000.0;
|
|
x = info->size[0] + 1; /* allowance */
|
|
set_delay(&(info->delayL), x);
|
|
set_delay(&(info->delayR), x);
|
|
info->index[0] = x - info->size[0];
|
|
info->level[0] = (double)reverb_status_gs.level * 1.82 / 127.0;
|
|
info->feedback = sqrt((double)reverb_status_gs.delay_feedback / 127.0) * 0.98;
|
|
info->leveli[0] = TIM_FSCALE(info->level[0], 24);
|
|
info->feedbacki = TIM_FSCALE(info->feedback, 24);
|
|
}
|
|
|
|
void Reverb::free_ch_reverb_delay(InfoDelay3 *info)
|
|
{
|
|
free_delay(&(info->delayL));
|
|
free_delay(&(info->delayR));
|
|
}
|
|
|
|
/*! Reverb: Panning Delay Effect; this implementation is specialized for system effect. */
|
|
void Reverb::do_ch_reverb_panning_delay(int32_t *buf, int32_t count, InfoDelay3 *info)
|
|
{
|
|
int32_t i, l, r;
|
|
simple_delay *delayL = &(info->delayL), *delayR = &(info->delayR);
|
|
int32_t *bufL = delayL->buf, *bufR = delayR->buf;
|
|
int32_t buf_index = delayL->index, buf_size = delayL->size;
|
|
int32_t index0 = info->index[0], level0i = info->leveli[0],
|
|
feedbacki = info->feedbacki;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_ch_reverb_delay(info);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_ch_reverb_delay(info);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
bufL[buf_index] = reverb_effect_buffer[i] + imuldiv24(bufR[index0], feedbacki);
|
|
l = imuldiv24(bufL[index0], level0i);
|
|
bufR[buf_index] = reverb_effect_buffer[i + 1] + imuldiv24(bufL[index0], feedbacki);
|
|
r = imuldiv24(bufR[index0], level0i);
|
|
|
|
buf[i] += r;
|
|
buf[++i] += l;
|
|
|
|
if (++index0 == buf_size) {index0 = 0;}
|
|
if (++buf_index == buf_size) {buf_index = 0;}
|
|
}
|
|
memset(reverb_effect_buffer, 0, sizeof(int32_t) * count);
|
|
info->index[0] = index0;
|
|
delayL->index = delayR->index = buf_index;
|
|
}
|
|
|
|
/*! Reverb: Normal Delay Effect; this implementation is specialized for system effect. */
|
|
void Reverb::do_ch_reverb_normal_delay(int32_t *buf, int32_t count, InfoDelay3 *info)
|
|
{
|
|
int32_t i;
|
|
simple_delay *delayL = &(info->delayL), *delayR = &(info->delayR);
|
|
int32_t *bufL = delayL->buf, *bufR = delayR->buf;
|
|
int32_t buf_index = delayL->index, buf_size = delayL->size;
|
|
int32_t index0 = info->index[0], level0i = info->leveli[0],
|
|
feedbacki = info->feedbacki;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_ch_reverb_delay(info);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_ch_reverb_delay(info);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
bufL[buf_index] = reverb_effect_buffer[i] + imuldiv24(bufL[index0], feedbacki);
|
|
buf[i] += imuldiv24(bufL[index0], level0i);
|
|
|
|
bufR[buf_index] = reverb_effect_buffer[++i] + imuldiv24(bufR[index0], feedbacki);
|
|
buf[i] += imuldiv24(bufR[index0], level0i);
|
|
|
|
if (++index0 == buf_size) {index0 = 0;}
|
|
if (++buf_index == buf_size) {buf_index = 0;}
|
|
}
|
|
memset(reverb_effect_buffer, 0, sizeof(int32_t) * count);
|
|
info->index[0] = index0;
|
|
delayL->index = delayR->index = buf_index;
|
|
}
|
|
|
|
/* */
|
|
/* Plate Reverberator */
|
|
/* */
|
|
#define PLATE_SAMPLERATE 29761.0
|
|
#define PLATE_DECAY 0.50
|
|
#define PLATE_DECAY_DIFFUSION1 0.70
|
|
#define PLATE_DECAY_DIFFUSION2 0.50
|
|
#define PLATE_INPUT_DIFFUSION1 0.750
|
|
#define PLATE_INPUT_DIFFUSION2 0.625
|
|
#define PLATE_BANDWIDTH 0.9955
|
|
#define PLATE_DAMPING 0.0005
|
|
#define PLATE_WET 0.25
|
|
|
|
/*! calculate delay sample in current sample-rate */
|
|
int32_t Reverb::get_plate_delay(double delay, double t)
|
|
{
|
|
return (int32_t)(delay * playback_rate * t / PLATE_SAMPLERATE);
|
|
}
|
|
|
|
/*! Plate Reverberator; this implementation is specialized for system effect. */
|
|
void Reverb::do_ch_plate_reverb(int32_t *buf, int32_t count, InfoPlateReverb *info)
|
|
{
|
|
int32_t i;
|
|
int32_t x, xd, val, outl, outr, temp1, temp2, temp3;
|
|
simple_delay *pd = &(info->pd), *od1l = &(info->od1l), *od2l = &(info->od2l),
|
|
*od3l = &(info->od3l), *od4l = &(info->od4l), *od5l = &(info->od5l),
|
|
*od6l = &(info->od6l), *od1r = &(info->od1r), *od2r = &(info->od2r),
|
|
*od3r = &(info->od3r), *od4r = &(info->od4r), *od5r = &(info->od5r),
|
|
*od7r = &(info->od7r), *od7l = &(info->od7l), *od6r = &(info->od6r),
|
|
*td1 = &(info->td1), *td2 = &(info->td2), *td1d = &(info->td1d), *td2d = &(info->td2d);
|
|
allpass *ap1 = &(info->ap1), *ap2 = &(info->ap2), *ap3 = &(info->ap3),
|
|
*ap4 = &(info->ap4), *ap6 = &(info->ap6), *ap6d = &(info->ap6d);
|
|
mod_allpass *ap5 = &(info->ap5), *ap5d = &(info->ap5d);
|
|
lfo *lfo1 = &(info->lfo1), *lfo1d = &(info->lfo1d);
|
|
filter_lowpass1 *lpf1 = &(info->lpf1), *lpf2 = &(info->lpf2);
|
|
int32_t t1 = info->t1, t1d = info->t1d;
|
|
int32_t decayi = info->decayi, ddif1i = info->ddif1i, ddif2i = info->ddif2i,
|
|
idif1i = info->idif1i, idif2i = info->idif2i;
|
|
double t;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_lfo(lfo1, 1.30, LFO_SINE, 0);
|
|
init_lfo(lfo1d, 1.30, LFO_SINE, 0);
|
|
t = reverb_time_table[reverb_status_gs.time] / reverb_time_table[64] - 1.0;
|
|
t = 1.0 + t / 2;
|
|
set_delay(pd, reverb_status_gs.pre_delay_time * playback_rate / 1000);
|
|
set_delay(td1, get_plate_delay(4453, t)),
|
|
set_delay(td1d, get_plate_delay(4217, t));
|
|
set_delay(td2, get_plate_delay(3720, t));
|
|
set_delay(td2d, get_plate_delay(3163, t));
|
|
set_delay(od1l, get_plate_delay(266, t));
|
|
set_delay(od2l, get_plate_delay(2974, t));
|
|
set_delay(od3l, get_plate_delay(1913, t));
|
|
set_delay(od4l, get_plate_delay(1996, t));
|
|
set_delay(od5l, get_plate_delay(1990, t));
|
|
set_delay(od6l, get_plate_delay(187, t));
|
|
set_delay(od7l, get_plate_delay(1066, t));
|
|
set_delay(od1r, get_plate_delay(353, t));
|
|
set_delay(od2r, get_plate_delay(3627, t));
|
|
set_delay(od3r, get_plate_delay(1228, t));
|
|
set_delay(od4r, get_plate_delay(2673, t));
|
|
set_delay(od5r, get_plate_delay(2111, t));
|
|
set_delay(od6r, get_plate_delay(335, t));
|
|
set_delay(od7r, get_plate_delay(121, t));
|
|
set_allpass(ap1, get_plate_delay(142, t), PLATE_INPUT_DIFFUSION1);
|
|
set_allpass(ap2, get_plate_delay(107, t), PLATE_INPUT_DIFFUSION1);
|
|
set_allpass(ap3, get_plate_delay(379, t), PLATE_INPUT_DIFFUSION2);
|
|
set_allpass(ap4, get_plate_delay(277, t), PLATE_INPUT_DIFFUSION2);
|
|
set_allpass(ap6, get_plate_delay(1800, t), PLATE_DECAY_DIFFUSION2);
|
|
set_allpass(ap6d, get_plate_delay(2656, t), PLATE_DECAY_DIFFUSION2);
|
|
set_mod_allpass(ap5, get_plate_delay(672, t), get_plate_delay(16, t), PLATE_DECAY_DIFFUSION1);
|
|
set_mod_allpass(ap5d, get_plate_delay(908, t), get_plate_delay(16, t), PLATE_DECAY_DIFFUSION1);
|
|
lpf1->a = PLATE_BANDWIDTH, lpf2->a = 1.0 - PLATE_DAMPING;
|
|
init_filter_lowpass1(lpf1);
|
|
init_filter_lowpass1(lpf2);
|
|
info->t1 = info->t1d = 0;
|
|
info->decay = PLATE_DECAY;
|
|
info->decayi = TIM_FSCALE(info->decay, 24);
|
|
info->ddif1 = PLATE_DECAY_DIFFUSION1;
|
|
info->ddif1i = TIM_FSCALE(info->ddif1, 24);
|
|
info->ddif2 = PLATE_DECAY_DIFFUSION2;
|
|
info->ddif2i = TIM_FSCALE(info->ddif2, 24);
|
|
info->idif1 = PLATE_INPUT_DIFFUSION1;
|
|
info->idif1i = TIM_FSCALE(info->idif1, 24);
|
|
info->idif2 = PLATE_INPUT_DIFFUSION2;
|
|
info->idif2i = TIM_FSCALE(info->idif2, 24);
|
|
info->wet = PLATE_WET * (double)reverb_status_gs.level / 127.0;
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_delay(pd); free_delay(td1); free_delay(td1d); free_delay(td2);
|
|
free_delay(td2d); free_delay(od1l); free_delay(od2l); free_delay(od3l);
|
|
free_delay(od4l); free_delay(od5l); free_delay(od6l); free_delay(od7l);
|
|
free_delay(od1r); free_delay(od2r); free_delay(od3r); free_delay(od4r);
|
|
free_delay(od5r); free_delay(od6r); free_delay(od7r); free_allpass(ap1);
|
|
free_allpass(ap2); free_allpass(ap3); free_allpass(ap4); free_allpass(ap6);
|
|
free_allpass(ap6d); free_mod_allpass(ap5); free_mod_allpass(ap5d);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i+=2)
|
|
{
|
|
outr = outl = 0;
|
|
x = (reverb_effect_buffer[i] + reverb_effect_buffer[i + 1]) >> 1;
|
|
reverb_effect_buffer[i] = reverb_effect_buffer[i + 1] = 0;
|
|
|
|
do_delay(&x, pd->buf, pd->size, &pd->index);
|
|
do_filter_lowpass1(&x, &lpf1->x1l, lpf1->ai, lpf1->iai);
|
|
do_allpass(&x, ap1->buf, ap1->size, &ap1->index, idif1i);
|
|
do_allpass(&x, ap2->buf, ap2->size, &ap2->index, idif1i);
|
|
do_allpass(&x, ap3->buf, ap3->size, &ap3->index, idif2i);
|
|
do_allpass(&x, ap4->buf, ap4->size, &ap4->index, idif2i);
|
|
|
|
/* tank structure */
|
|
xd = x;
|
|
x += imuldiv24(t1d, decayi);
|
|
val = do_lfo(lfo1);
|
|
do_mod_allpass(&x, ap5->buf, ap5->size, &ap5->rindex, &ap5->windex,
|
|
ap5->ndelay, ap5->depth, val, &ap5->hist, ddif1i);
|
|
temp1 = temp2 = temp3 = x; /* n_out_1 */
|
|
do_delay(&temp1, od5l->buf, od5l->size, &od5l->index);
|
|
outl -= temp1; /* left output 5 */
|
|
do_delay(&temp2, od1r->buf, od1r->size, &od1r->index);
|
|
outr += temp2; /* right output 1 */
|
|
do_delay(&temp3, od2r->buf, od2r->size, &od2r->index);
|
|
outr += temp3; /* right output 2 */
|
|
do_delay(&x, td1->buf, td1->size, &td1->index);
|
|
do_filter_lowpass1(&x, &lpf2->x1l, lpf2->ai, lpf2->iai);
|
|
temp1 = temp2 = x; /* n_out_2 */
|
|
do_delay(&temp1, od6l->buf, od6l->size, &od6l->index);
|
|
outl -= temp1; /* left output 6 */
|
|
do_delay(&temp2, od3r->buf, od3r->size, &od3r->index);
|
|
outr -= temp2; /* right output 3 */
|
|
x = imuldiv24(x, decayi);
|
|
do_allpass(&x, ap6->buf, ap6->size, &ap6->index, ddif2i);
|
|
temp1 = temp2 = x; /* n_out_3 */
|
|
do_delay(&temp1, od7l->buf, od7l->size, &od7l->index);
|
|
outl -= temp1; /* left output 7 */
|
|
do_delay(&temp2, od4r->buf, od4r->size, &od4r->index);
|
|
outr += temp2; /* right output 4 */
|
|
do_delay(&x, td2->buf, td2->size, &td2->index);
|
|
t1 = x;
|
|
|
|
xd += imuldiv24(t1, decayi);
|
|
val = do_lfo(lfo1d);
|
|
do_mod_allpass(&x, ap5d->buf, ap5d->size, &ap5d->rindex, &ap5d->windex,
|
|
ap5d->ndelay, ap5d->depth, val, &ap5d->hist, ddif1i);
|
|
temp1 = temp2 = temp3 = xd; /* n_out_4 */
|
|
do_delay(&temp1, od1l->buf, od1l->size, &od1l->index);
|
|
outl += temp1; /* left output 1 */
|
|
do_delay(&temp2, od2l->buf, od2l->size, &od2l->index);
|
|
outl += temp2; /* left output 2 */
|
|
do_delay(&temp3, od6r->buf, od6r->size, &od6r->index);
|
|
outr -= temp3; /* right output 6 */
|
|
do_delay(&xd, td1d->buf, td1d->size, &td1d->index);
|
|
do_filter_lowpass1(&xd, &lpf2->x1r, lpf2->ai, lpf2->iai);
|
|
temp1 = temp2 = xd; /* n_out_5 */
|
|
do_delay(&temp1, od3l->buf, od3l->size, &od3l->index);
|
|
outl -= temp1; /* left output 3 */
|
|
do_delay(&temp2, od6r->buf, od6r->size, &od6r->index);
|
|
outr -= temp2; /* right output 6 */
|
|
xd = imuldiv24(xd, decayi);
|
|
do_allpass(&xd, ap6d->buf, ap6d->size, &ap6d->index, ddif2i);
|
|
temp1 = temp2 = xd; /* n_out_6 */
|
|
do_delay(&temp1, od4l->buf, od4l->size, &od4l->index);
|
|
outl += temp1; /* left output 4 */
|
|
do_delay(&temp2, od7r->buf, od7r->size, &od7r->index);
|
|
outr -= temp2; /* right output 7 */
|
|
do_delay(&xd, td2d->buf, td2d->size, &td2d->index);
|
|
t1d = xd;
|
|
|
|
buf[i] += outl;
|
|
buf[i + 1] += outr;
|
|
}
|
|
info->t1 = t1, info->t1d = t1d;
|
|
}
|
|
|
|
/*! initialize Reverb Effect */
|
|
void Reverb::init_reverb(void)
|
|
{
|
|
init_filter_lowpass1(&(reverb_status_gs.lpf));
|
|
/* Only initialize freeverb if stereo output */
|
|
/* Old non-freeverb must be initialized for mono reverb not to crash */
|
|
if ( (timidity_reverb == 3 || timidity_reverb == 4
|
|
|| (timidity_reverb < 0 && ! (timidity_reverb & 0x100)))) {
|
|
switch(reverb_status_gs.character) { /* select reverb algorithm */
|
|
case 5: /* Plate Reverb */
|
|
do_ch_plate_reverb(NULL, MAGIC_INIT_EFFECT_INFO, &(reverb_status_gs.info_plate_reverb));
|
|
REV_INP_LEV = reverb_status_gs.info_plate_reverb.wet;
|
|
break;
|
|
case 6: /* Delay */
|
|
do_ch_reverb_normal_delay(NULL, MAGIC_INIT_EFFECT_INFO, &(reverb_status_gs.info_reverb_delay));
|
|
REV_INP_LEV = 1.0;
|
|
break;
|
|
case 7: /* Panning Delay */
|
|
do_ch_reverb_panning_delay(NULL, MAGIC_INIT_EFFECT_INFO, &(reverb_status_gs.info_reverb_delay));
|
|
REV_INP_LEV = 1.0;
|
|
break;
|
|
default: /* Freeverb */
|
|
do_ch_freeverb(NULL, MAGIC_INIT_EFFECT_INFO, &(reverb_status_gs.info_freeverb));
|
|
REV_INP_LEV = reverb_status_gs.info_freeverb.wet;
|
|
break;
|
|
}
|
|
} else { /* Old Reverb */
|
|
do_ch_standard_reverb(NULL, MAGIC_INIT_EFFECT_INFO, &(reverb_status_gs.info_standard_reverb));
|
|
REV_INP_LEV = 1.0;
|
|
}
|
|
memset(reverb_effect_buffer, 0, reverb_effect_bufsize);
|
|
memset(direct_buffer, 0, direct_bufsize);
|
|
}
|
|
|
|
void Reverb::do_ch_reverb(int32_t *buf, int32_t count)
|
|
{
|
|
#ifdef SYS_EFFECT_PRE_LPF
|
|
if ((timidity_reverb == 3 || timidity_reverb == 4
|
|
|| (timidity_reverb < 0 && ! (timidity_reverb & 0x100))) && reverb_status_gs.pre_lpf)
|
|
do_filter_lowpass1_stereo(reverb_effect_buffer, count, &(reverb_status_gs.lpf));
|
|
#endif /* SYS_EFFECT_PRE_LPF */
|
|
if (timidity_reverb == 3 || timidity_reverb == 4
|
|
|| (timidity_reverb < 0 && ! (timidity_reverb & 0x100))) {
|
|
switch(reverb_status_gs.character) { /* select reverb algorithm */
|
|
case 5: /* Plate Reverb */
|
|
do_ch_plate_reverb(buf, count, &(reverb_status_gs.info_plate_reverb));
|
|
REV_INP_LEV = reverb_status_gs.info_plate_reverb.wet;
|
|
break;
|
|
case 6: /* Delay */
|
|
do_ch_reverb_normal_delay(buf, count, &(reverb_status_gs.info_reverb_delay));
|
|
REV_INP_LEV = 1.0;
|
|
break;
|
|
case 7: /* Panning Delay */
|
|
do_ch_reverb_panning_delay(buf, count, &(reverb_status_gs.info_reverb_delay));
|
|
REV_INP_LEV = 1.0;
|
|
break;
|
|
default: /* Freeverb */
|
|
do_ch_freeverb(buf, count, &(reverb_status_gs.info_freeverb));
|
|
REV_INP_LEV = reverb_status_gs.info_freeverb.wet;
|
|
break;
|
|
}
|
|
} else { /* Old Reverb */
|
|
do_ch_standard_reverb(buf, count, &(reverb_status_gs.info_standard_reverb));
|
|
}
|
|
}
|
|
|
|
/* */
|
|
/* Delay Effect */
|
|
/* */
|
|
|
|
void Reverb::init_ch_delay(void)
|
|
{
|
|
memset(delay_effect_buffer, 0, sizeof(delay_effect_buffer));
|
|
init_filter_lowpass1(&(delay_status_gs.lpf));
|
|
do_ch_3tap_delay(NULL, MAGIC_INIT_EFFECT_INFO, &(delay_status_gs.info_delay));
|
|
}
|
|
|
|
void Reverb::do_ch_delay(int32_t *buf, int32_t count)
|
|
{
|
|
#ifdef SYS_EFFECT_PRE_LPF
|
|
if ((timidity_reverb == 3 || timidity_reverb == 4
|
|
|| (timidity_reverb < 0 && ! (timidity_reverb & 0x100))) && delay_status_gs.pre_lpf)
|
|
do_filter_lowpass1_stereo(delay_effect_buffer, count, &(delay_status_gs.lpf));
|
|
#endif /* SYS_EFFECT_PRE_LPF */
|
|
switch (delay_status_gs.type) {
|
|
case 1:
|
|
do_ch_3tap_delay(buf, count, &(delay_status_gs.info_delay));
|
|
break;
|
|
case 2:
|
|
do_ch_cross_delay(buf, count, &(delay_status_gs.info_delay));
|
|
break;
|
|
default:
|
|
do_ch_normal_delay(buf, count, &(delay_status_gs.info_delay));
|
|
break;
|
|
}
|
|
}
|
|
|
|
void Reverb::set_ch_delay(int32_t *sbuffer, int32_t n, int32_t level)
|
|
{
|
|
int32_t i;
|
|
if(!level) {return;}
|
|
double send_level = (double)level / 127.0;
|
|
|
|
for(i = 0; i < n; i++)
|
|
{
|
|
delay_effect_buffer[i] += int32_t(sbuffer[i] * send_level);
|
|
}
|
|
}
|
|
|
|
/*! initialize Delay Effect; this implementation is specialized for system effect. */
|
|
void Reverb::init_ch_3tap_delay(InfoDelay3 *info)
|
|
{
|
|
int32_t i, x;
|
|
|
|
for (i = 0; i < 3; i++) {
|
|
info->size[i] = delay_status_gs.sample[i];
|
|
}
|
|
x = info->size[0]; /* find maximum value */
|
|
for (i = 1; i < 3; i++) {
|
|
if (info->size[i] > x) {x = info->size[i];}
|
|
}
|
|
x += 1; /* allowance */
|
|
set_delay(&(info->delayL), x);
|
|
set_delay(&(info->delayR), x);
|
|
for (i = 0; i < 3; i++) {
|
|
info->index[i] = (x - info->size[i]) % x; /* set start-point */
|
|
info->level[i] = delay_status_gs.level_ratio[i] * MASTER_DELAY_LEVEL;
|
|
info->leveli[i] = TIM_FSCALE(info->level[i], 24);
|
|
}
|
|
info->feedback = delay_status_gs.feedback_ratio;
|
|
info->send_reverb = delay_status_gs.send_reverb_ratio * REV_INP_LEV;
|
|
info->feedbacki = TIM_FSCALE(info->feedback, 24);
|
|
info->send_reverbi = TIM_FSCALE(info->send_reverb, 24);
|
|
}
|
|
|
|
void Reverb::free_ch_3tap_delay(InfoDelay3 *info)
|
|
{
|
|
free_delay(&(info->delayL));
|
|
free_delay(&(info->delayR));
|
|
}
|
|
|
|
/*! 3-Tap Stereo Delay Effect; this implementation is specialized for system effect. */
|
|
void Reverb::do_ch_3tap_delay(int32_t *buf, int32_t count, InfoDelay3 *info)
|
|
{
|
|
int32_t i, x;
|
|
simple_delay *delayL = &(info->delayL), *delayR = &(info->delayR);
|
|
int32_t *bufL = delayL->buf, *bufR = delayR->buf;
|
|
int32_t buf_index = delayL->index, buf_size = delayL->size;
|
|
int32_t index0 = info->index[0], index1 = info->index[1], index2 = info->index[2];
|
|
int32_t level0i = info->leveli[0], level1i = info->leveli[1], level2i = info->leveli[2],
|
|
feedbacki = info->feedbacki, send_reverbi = info->send_reverbi;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_ch_3tap_delay(info);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_ch_3tap_delay(info);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
bufL[buf_index] = delay_effect_buffer[i] + imuldiv24(bufL[index0], feedbacki);
|
|
x = imuldiv24(bufL[index0], level0i) + imuldiv24(bufL[index1] + bufR[index1], level1i);
|
|
buf[i] += x;
|
|
reverb_effect_buffer[i] += imuldiv24(x, send_reverbi);
|
|
|
|
bufR[buf_index] = delay_effect_buffer[++i] + imuldiv24(bufR[index0], feedbacki);
|
|
x = imuldiv24(bufR[index0], level0i) + imuldiv24(bufL[index2] + bufR[index2], level2i);
|
|
buf[i] += x;
|
|
reverb_effect_buffer[i] += imuldiv24(x, send_reverbi);
|
|
|
|
if (++index0 == buf_size) {index0 = 0;}
|
|
if (++index1 == buf_size) {index1 = 0;}
|
|
if (++index2 == buf_size) {index2 = 0;}
|
|
if (++buf_index == buf_size) {buf_index = 0;}
|
|
}
|
|
memset(delay_effect_buffer, 0, sizeof(int32_t) * count);
|
|
info->index[0] = index0, info->index[1] = index1, info->index[2] = index2;
|
|
delayL->index = delayR->index = buf_index;
|
|
}
|
|
|
|
/*! Cross Delay Effect; this implementation is specialized for system effect. */
|
|
void Reverb::do_ch_cross_delay(int32_t *buf, int32_t count, InfoDelay3 *info)
|
|
{
|
|
int32_t i, l, r;
|
|
simple_delay *delayL = &(info->delayL), *delayR = &(info->delayR);
|
|
int32_t *bufL = delayL->buf, *bufR = delayR->buf;
|
|
int32_t buf_index = delayL->index, buf_size = delayL->size;
|
|
int32_t index0 = info->index[0], level0i = info->leveli[0],
|
|
feedbacki = info->feedbacki, send_reverbi = info->send_reverbi;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_ch_3tap_delay(info);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_ch_3tap_delay(info);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
bufL[buf_index] = delay_effect_buffer[i] + imuldiv24(bufR[index0], feedbacki);
|
|
l = imuldiv24(bufL[index0], level0i);
|
|
bufR[buf_index] = delay_effect_buffer[i + 1] + imuldiv24(bufL[index0], feedbacki);
|
|
r = imuldiv24(bufR[index0], level0i);
|
|
|
|
buf[i] += r;
|
|
reverb_effect_buffer[i] += imuldiv24(r, send_reverbi);
|
|
buf[++i] += l;
|
|
reverb_effect_buffer[i] += imuldiv24(l, send_reverbi);
|
|
|
|
if (++index0 == buf_size) {index0 = 0;}
|
|
if (++buf_index == buf_size) {buf_index = 0;}
|
|
}
|
|
memset(delay_effect_buffer, 0, sizeof(int32_t) * count);
|
|
info->index[0] = index0;
|
|
delayL->index = delayR->index = buf_index;
|
|
}
|
|
|
|
/*! Normal Delay Effect; this implementation is specialized for system effect. */
|
|
void Reverb::do_ch_normal_delay(int32_t *buf, int32_t count, InfoDelay3 *info)
|
|
{
|
|
int32_t i, x;
|
|
simple_delay *delayL = &(info->delayL), *delayR = &(info->delayR);
|
|
int32_t *bufL = delayL->buf, *bufR = delayR->buf;
|
|
int32_t buf_index = delayL->index, buf_size = delayL->size;
|
|
int32_t index0 = info->index[0], level0i = info->leveli[0],
|
|
feedbacki = info->feedbacki, send_reverbi = info->send_reverbi;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_ch_3tap_delay(info);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_ch_3tap_delay(info);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
bufL[buf_index] = delay_effect_buffer[i] + imuldiv24(bufL[index0], feedbacki);
|
|
x = imuldiv24(bufL[index0], level0i);
|
|
buf[i] += x;
|
|
reverb_effect_buffer[i] += imuldiv24(x, send_reverbi);
|
|
|
|
bufR[buf_index] = delay_effect_buffer[++i] + imuldiv24(bufR[index0], feedbacki);
|
|
x = imuldiv24(bufR[index0], level0i);
|
|
buf[i] += x;
|
|
reverb_effect_buffer[i] += imuldiv24(x, send_reverbi);
|
|
|
|
if (++index0 == buf_size) {index0 = 0;}
|
|
if (++buf_index == buf_size) {buf_index = 0;}
|
|
}
|
|
memset(delay_effect_buffer, 0, sizeof(int32_t) * count);
|
|
info->index[0] = index0;
|
|
delayL->index = delayR->index = buf_index;
|
|
}
|
|
|
|
/* */
|
|
/* Chorus Effect */
|
|
/* */
|
|
|
|
/*! Stereo Chorus; this implementation is specialized for system effect. */
|
|
void Reverb::do_ch_stereo_chorus(int32_t *buf, int32_t count, InfoStereoChorus *info)
|
|
{
|
|
int32_t i, output, f0, f1, v0, v1;
|
|
int32_t *bufL = info->delayL.buf, *bufR = info->delayR.buf,
|
|
*lfobufL = info->lfoL.buf, *lfobufR = info->lfoR.buf,
|
|
icycle = info->lfoL.icycle, cycle = info->lfoL.cycle,
|
|
leveli = info->leveli, feedbacki = info->feedbacki,
|
|
send_reverbi = info->send_reverbi, send_delayi = info->send_delayi,
|
|
depth = info->depth, pdelay = info->pdelay, rpt0 = info->rpt0;
|
|
int32_t wpt0 = info->wpt0, spt0 = info->spt0, spt1 = info->spt1,
|
|
hist0 = info->hist0, hist1 = info->hist1, lfocnt = info->lfoL.count;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_lfo(&(info->lfoL), (double)chorus_status_gs.rate * 0.122, LFO_TRIANGULAR, 0);
|
|
init_lfo(&(info->lfoR), (double)chorus_status_gs.rate * 0.122, LFO_TRIANGULAR, 90);
|
|
info->pdelay = chorus_delay_time_table[chorus_status_gs.delay] * (double)playback_rate / 1000.0;
|
|
info->depth = (double)(chorus_status_gs.depth + 1) / 3.2 * (double)playback_rate / 1000.0;
|
|
info->pdelay -= info->depth / 2; /* NOMINAL_DELAY to delay */
|
|
if (info->pdelay < 1) {info->pdelay = 1;}
|
|
info->rpt0 = info->pdelay + info->depth + 2; /* allowance */
|
|
set_delay(&(info->delayL), info->rpt0);
|
|
set_delay(&(info->delayR), info->rpt0);
|
|
info->feedback = (double)chorus_status_gs.feedback * 0.763 / 100.0;
|
|
info->level = (double)chorus_status_gs.level / 127.0 * MASTER_CHORUS_LEVEL;
|
|
info->send_reverb = (double)chorus_status_gs.send_reverb * 0.787 / 100.0 * REV_INP_LEV;
|
|
info->send_delay = (double)chorus_status_gs.send_delay * 0.787 / 100.0;
|
|
info->feedbacki = TIM_FSCALE(info->feedback, 24);
|
|
info->leveli = TIM_FSCALE(info->level, 24);
|
|
info->send_reverbi = TIM_FSCALE(info->send_reverb, 24);
|
|
info->send_delayi = TIM_FSCALE(info->send_delay, 24);
|
|
info->wpt0 = info->spt0 = info->spt1 = info->hist0 = info->hist1 = 0;
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_delay(&(info->delayL));
|
|
free_delay(&(info->delayR));
|
|
return;
|
|
}
|
|
|
|
if (bufL == nullptr)
|
|
{
|
|
set_delay(&(info->delayL), info->rpt0);
|
|
set_delay(&(info->delayR), info->rpt0);
|
|
bufL = info->delayL.buf;
|
|
bufR = info->delayR.buf;
|
|
}
|
|
|
|
/* LFO */
|
|
f0 = imuldiv24(lfobufL[imuldiv24(lfocnt, icycle)], depth);
|
|
spt0 = wpt0 - pdelay - (f0 >> 8); /* integral part of delay */
|
|
f0 = 0xFF - (f0 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt0 < 0) {spt0 += rpt0;}
|
|
f1 = imuldiv24(lfobufR[imuldiv24(lfocnt, icycle)], depth);
|
|
spt1 = wpt0 - pdelay - (f1 >> 8); /* integral part of delay */
|
|
f1 = 0xFF - (f1 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt1 < 0) {spt1 += rpt0;}
|
|
|
|
for(i = 0; i < count; i++) {
|
|
v0 = bufL[spt0];
|
|
v1 = bufR[spt1];
|
|
|
|
/* LFO */
|
|
if(++wpt0 == rpt0) {wpt0 = 0;}
|
|
f0 = imuldiv24(lfobufL[imuldiv24(lfocnt, icycle)], depth);
|
|
spt0 = wpt0 - pdelay - (f0 >> 8); /* integral part of delay */
|
|
f0 = 0xFF - (f0 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt0 < 0) {spt0 += rpt0;}
|
|
f1 = imuldiv24(lfobufR[imuldiv24(lfocnt, icycle)], depth);
|
|
spt1 = wpt0 - pdelay - (f1 >> 8); /* integral part of delay */
|
|
f1 = 0xFF - (f1 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt1 < 0) {spt1 += rpt0;}
|
|
if(++lfocnt == cycle) {lfocnt = 0;}
|
|
|
|
/* left */
|
|
/* delay with all-pass interpolation */
|
|
output = hist0 = v0 + imuldiv8(bufL[spt0] - hist0, f0);
|
|
bufL[wpt0] = chorus_effect_buffer[i] + imuldiv24(output, feedbacki);
|
|
output = imuldiv24(output, leveli);
|
|
buf[i] += output;
|
|
/* send to other system effects (it's peculiar to GS) */
|
|
reverb_effect_buffer[i] += imuldiv24(output, send_reverbi);
|
|
delay_effect_buffer[i] += imuldiv24(output, send_delayi);
|
|
|
|
/* right */
|
|
/* delay with all-pass interpolation */
|
|
output = hist1 = v1 + imuldiv8(bufR[spt1] - hist1, f1);
|
|
bufR[wpt0] = chorus_effect_buffer[++i] + imuldiv24(output, feedbacki);
|
|
output = imuldiv24(output, leveli);
|
|
buf[i] += output;
|
|
/* send to other system effects (it's peculiar to GS) */
|
|
reverb_effect_buffer[i] += imuldiv24(output, send_reverbi);
|
|
delay_effect_buffer[i] += imuldiv24(output, send_delayi);
|
|
}
|
|
memset(chorus_effect_buffer, 0, sizeof(int32_t) * count);
|
|
info->wpt0 = wpt0, info->spt0 = spt0, info->spt1 = spt1,
|
|
info->hist0 = hist0, info->hist1 = hist1;
|
|
info->lfoL.count = info->lfoR.count = lfocnt;
|
|
}
|
|
|
|
void Reverb::init_ch_chorus(void)
|
|
{
|
|
/* clear delay-line of LPF */
|
|
init_filter_lowpass1(&(chorus_status_gs.lpf));
|
|
do_ch_stereo_chorus(NULL, MAGIC_INIT_EFFECT_INFO, &(chorus_status_gs.info_stereo_chorus));
|
|
memset(chorus_effect_buffer, 0, sizeof(chorus_effect_buffer));
|
|
}
|
|
|
|
void Reverb::set_ch_chorus(int32_t *sbuffer,int32_t n, int32_t level)
|
|
{
|
|
int32_t i;
|
|
int32_t count = n;
|
|
if(!level) {return;}
|
|
double send_level = (double)level / 127.0;
|
|
|
|
for(i = 0; i < count; i++)
|
|
{
|
|
chorus_effect_buffer[i] += int32_t(sbuffer[i] * send_level);
|
|
}
|
|
}
|
|
|
|
void Reverb::do_ch_chorus(int32_t *buf, int32_t count)
|
|
{
|
|
#ifdef SYS_EFFECT_PRE_LPF
|
|
if ((timidity_reverb == 3 || timidity_reverb == 4
|
|
|| (timidity_reverb < 0 && ! (timidity_reverb & 0x100))) && chorus_status_gs.pre_lpf)
|
|
do_filter_lowpass1_stereo(chorus_effect_buffer, count, &(chorus_status_gs.lpf));
|
|
#endif /* SYS_EFFECT_PRE_LPF */
|
|
|
|
do_ch_stereo_chorus(buf, count, &(chorus_status_gs.info_stereo_chorus));
|
|
}
|
|
|
|
/* */
|
|
/* EQ (Equalizer) */
|
|
/* */
|
|
|
|
void Reverb::init_eq_gs()
|
|
{
|
|
memset(eq_buffer, 0, sizeof(eq_buffer));
|
|
calc_filter_shelving_low(&(eq_status_gs.lsf));
|
|
calc_filter_shelving_high(&(eq_status_gs.hsf));
|
|
}
|
|
|
|
void Reverb::do_ch_eq_gs(int32_t* buf, int32_t count)
|
|
{
|
|
int32_t i;
|
|
|
|
do_shelving_filter_stereo(eq_buffer, count, &(eq_status_gs.lsf));
|
|
do_shelving_filter_stereo(eq_buffer, count, &(eq_status_gs.hsf));
|
|
|
|
for(i = 0; i < count; i++) {
|
|
buf[i] += eq_buffer[i];
|
|
eq_buffer[i] = 0;
|
|
}
|
|
}
|
|
|
|
void Reverb::do_ch_eq_xg(int32_t* buf, int32_t count, struct part_eq_xg *p)
|
|
{
|
|
if(p->bass - 0x40 != 0) {
|
|
do_shelving_filter_stereo(buf, count, &(p->basss));
|
|
}
|
|
if(p->treble - 0x40 != 0) {
|
|
do_shelving_filter_stereo(buf, count, &(p->trebles));
|
|
}
|
|
}
|
|
|
|
void Reverb::do_multi_eq_xg(int32_t* buf, int32_t count)
|
|
{
|
|
if(multi_eq_xg.valid1) {
|
|
if(multi_eq_xg.shape1) { /* peaking */
|
|
do_peaking_filter_stereo(buf, count, &(multi_eq_xg.eq1p));
|
|
} else { /* shelving */
|
|
do_shelving_filter_stereo(buf, count, &(multi_eq_xg.eq1s));
|
|
}
|
|
}
|
|
if(multi_eq_xg.valid2) {
|
|
do_peaking_filter_stereo(buf, count, &(multi_eq_xg.eq2p));
|
|
}
|
|
if(multi_eq_xg.valid3) {
|
|
do_peaking_filter_stereo(buf, count, &(multi_eq_xg.eq3p));
|
|
}
|
|
if(multi_eq_xg.valid4) {
|
|
do_peaking_filter_stereo(buf, count, &(multi_eq_xg.eq4p));
|
|
}
|
|
if(multi_eq_xg.valid5) {
|
|
if(multi_eq_xg.shape5) { /* peaking */
|
|
do_peaking_filter_stereo(buf, count, &(multi_eq_xg.eq5p));
|
|
} else { /* shelving */
|
|
do_shelving_filter_stereo(buf, count, &(multi_eq_xg.eq5s));
|
|
}
|
|
}
|
|
}
|
|
|
|
void Reverb::set_ch_eq_gs(int32_t *sbuffer, int32_t n)
|
|
{
|
|
int32_t i;
|
|
|
|
for(i = 0; i < n; i++)
|
|
{
|
|
eq_buffer[i] += sbuffer[i];
|
|
}
|
|
}
|
|
|
|
|
|
/* */
|
|
/* Insertion and Variation Effect */
|
|
/* */
|
|
void Reverb::do_insertion_effect_gs(int32_t *buf, int32_t count)
|
|
{
|
|
do_effect_list(buf, count, insertion_effect_gs.ef);
|
|
}
|
|
|
|
void Reverb::do_insertion_effect_xg(int32_t *buf, int32_t count, struct effect_xg_t *st)
|
|
{
|
|
do_effect_list(buf, count, st->ef);
|
|
}
|
|
|
|
void Reverb::do_variation_effect1_xg(int32_t *buf, int32_t count)
|
|
{
|
|
int32_t i, x;
|
|
int32_t send_reverbi = TIM_FSCALE((double)variation_effect_xg[0].send_reverb * (0.787 / 100.0 * REV_INP_LEV), 24),
|
|
send_chorusi = TIM_FSCALE((double)variation_effect_xg[0].send_chorus * (0.787 / 100.0), 24);
|
|
if (variation_effect_xg[0].connection == XG_CONN_SYSTEM) {
|
|
do_effect_list(delay_effect_buffer, count, variation_effect_xg[0].ef);
|
|
for (i = 0; i < count; i++) {
|
|
x = delay_effect_buffer[i];
|
|
buf[i] += x;
|
|
reverb_effect_buffer[i] += imuldiv24(x, send_reverbi);
|
|
chorus_effect_buffer[i] += imuldiv24(x, send_chorusi);
|
|
}
|
|
}
|
|
memset(delay_effect_buffer, 0, sizeof(int32_t) * count);
|
|
}
|
|
|
|
void Reverb::do_ch_chorus_xg(int32_t *buf, int32_t count)
|
|
{
|
|
int32_t i;
|
|
int32_t send_reverbi = TIM_FSCALE((double)chorus_status_xg.send_reverb * (0.787 / 100.0 * REV_INP_LEV), 24);
|
|
|
|
do_effect_list(chorus_effect_buffer, count, chorus_status_xg.ef);
|
|
for (i = 0; i < count; i++) {
|
|
buf[i] += chorus_effect_buffer[i];
|
|
reverb_effect_buffer[i] += imuldiv24(chorus_effect_buffer[i], send_reverbi);
|
|
}
|
|
memset(chorus_effect_buffer, 0, sizeof(int32_t) * count);
|
|
}
|
|
|
|
void Reverb::do_ch_reverb_xg(int32_t *buf, int32_t count)
|
|
{
|
|
int32_t i;
|
|
|
|
do_effect_list(reverb_effect_buffer, count, reverb_status_xg.ef);
|
|
for (i = 0; i < count; i++) {
|
|
buf[i] += reverb_effect_buffer[i];
|
|
}
|
|
memset(reverb_effect_buffer, 0, sizeof(int32_t) * count);
|
|
}
|
|
|
|
void Reverb::init_ch_effect_xg(void)
|
|
{
|
|
memset(reverb_effect_buffer, 0, sizeof(reverb_effect_buffer));
|
|
memset(chorus_effect_buffer, 0, sizeof(chorus_effect_buffer));
|
|
memset(delay_effect_buffer, 0, sizeof(delay_effect_buffer));
|
|
}
|
|
|
|
void Reverb::alloc_effect(EffectList *ef)
|
|
{
|
|
int i;
|
|
|
|
ef->engine = NULL;
|
|
for(i = 0; effect_engine[i].type != -1; i++) {
|
|
if (effect_engine[i].type == ef->type) {
|
|
ef->engine = &(effect_engine[i]);
|
|
break;
|
|
}
|
|
}
|
|
if (ef->engine == NULL) {return;}
|
|
|
|
if (ef->info != NULL) {
|
|
free(ef->info);
|
|
ef->info = NULL;
|
|
}
|
|
ef->info = safe_malloc(ef->engine->info_size);
|
|
memset(ef->info, 0, ef->engine->info_size);
|
|
|
|
/* //printMessage(CMSG_INFO,VERB_NOISY,"Effect Engine: %s", ef->engine->name); */
|
|
}
|
|
|
|
/*! allocate new effect item and add it into the tail of effect list.
|
|
EffectList *efc: pointer to the top of effect list.
|
|
int8_t type: type of new effect item.
|
|
void *info: pointer to infomation of new effect item. */
|
|
EffectList *Reverb::push_effect(EffectList *efc, int type)
|
|
{
|
|
EffectList *eft, *efn;
|
|
if (type == EFFECT_NONE) {return NULL;}
|
|
efn = (EffectList *)safe_malloc(sizeof(EffectList));
|
|
memset(efn, 0, sizeof(EffectList));
|
|
efn->type = type;
|
|
efn->next_ef = NULL;
|
|
efn->info = NULL;
|
|
alloc_effect(efn);
|
|
|
|
if(efc == NULL) {
|
|
efc = efn;
|
|
} else {
|
|
eft = efc;
|
|
while(eft->next_ef != NULL) {
|
|
eft = eft->next_ef;
|
|
}
|
|
eft->next_ef = efn;
|
|
}
|
|
return efc;
|
|
}
|
|
|
|
/*! process all items of effect list. */
|
|
void Reverb::do_effect_list(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
EffectList *efc = ef;
|
|
if(ef == NULL) {return;}
|
|
while(efc != NULL && efc->engine->do_effect != NULL)
|
|
{
|
|
(this->*(efc->engine->do_effect))(buf, count, efc);
|
|
efc = efc->next_ef;
|
|
}
|
|
}
|
|
|
|
/*! free all items of effect list. */
|
|
void Reverb::free_effect_list(EffectList *ef)
|
|
{
|
|
EffectList *efc, *efn;
|
|
efc = ef;
|
|
if (efc == NULL) {return;}
|
|
do {
|
|
efn = efc->next_ef;
|
|
if(efc->info != NULL) {
|
|
(this->*(efc->engine->do_effect))(NULL, MAGIC_FREE_EFFECT_INFO, efc);
|
|
free(efc->info);
|
|
efc->info = NULL;
|
|
}
|
|
efc->engine = NULL;
|
|
free(efc);
|
|
efc = NULL;
|
|
} while ((efc = efn) != NULL);
|
|
}
|
|
|
|
/*! 2-Band EQ */
|
|
void Reverb::do_eq2(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
InfoEQ2 *eq = (InfoEQ2 *)ef->info;
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
eq->lsf.q = 0;
|
|
eq->lsf.freq = eq->low_freq;
|
|
eq->lsf.gain = eq->low_gain;
|
|
calc_filter_shelving_low(&(eq->lsf));
|
|
eq->hsf.q = 0;
|
|
eq->hsf.freq = eq->high_freq;
|
|
eq->hsf.gain = eq->high_gain;
|
|
calc_filter_shelving_high(&(eq->hsf));
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
if(eq->low_gain != 0) {
|
|
do_shelving_filter_stereo(buf, count, &(eq->lsf));
|
|
}
|
|
if(eq->high_gain != 0) {
|
|
do_shelving_filter_stereo(buf, count, &(eq->hsf));
|
|
}
|
|
}
|
|
|
|
/*! panning (pan = [0, 127]) */
|
|
int32_t Reverb::do_left_panning(int32_t sample, int32_t pan)
|
|
{
|
|
return imuldiv8(sample, 256 - pan - pan);
|
|
}
|
|
|
|
int32_t Reverb::do_right_panning(int32_t sample, int32_t pan)
|
|
{
|
|
return imuldiv8(sample, pan + pan);
|
|
}
|
|
|
|
#define OD_BITS 28
|
|
#define OD_MAX_NEG (1.0 / (double)(1L << OD_BITS))
|
|
#define OD_DRIVE_GS 4.0
|
|
#define OD_LEVEL_GS 0.5
|
|
#define STEREO_OD_BITS 27
|
|
#define STEREO_OD_MAX_NEG (1.0 / (double)(1L << STEREO_OD_BITS))
|
|
#define OVERDRIVE_DIST 4.0
|
|
#define OVERDRIVE_RES 0.1
|
|
#define OVERDRIVE_LEVEL 1.0
|
|
#define OVERDRIVE_OFFSET 0
|
|
#define DISTORTION_DIST 40.0
|
|
#define DISTORTION_RES 0.2
|
|
#define DISTORTION_LEVEL 0.2
|
|
#define DISTORTION_OFFSET 0
|
|
|
|
double Reverb::calc_gs_drive(int val)
|
|
{
|
|
return (OD_DRIVE_GS * (double)val / 127.0 + 1.0);
|
|
}
|
|
|
|
/*! GS 0x0110: Overdrive 1 */
|
|
void Reverb::do_overdrive1(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
InfoOverdrive1 *info = (InfoOverdrive1 *)ef->info;
|
|
filter_moog *svf = &(info->svf);
|
|
filter_biquad *lpf1 = &(info->lpf1);
|
|
void (Reverb::*do_amp_sim)(int32_t *, int32_t) = info->amp_sim;
|
|
int32_t i, input, high, leveli = info->leveli, di = info->di,
|
|
pan = info->pan, asdi = TIM_FSCALE(1.0, 24);
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
/* decompositor */
|
|
svf->freq = 500;
|
|
svf->res_dB = 0;
|
|
calc_filter_moog(svf);
|
|
init_filter_moog(svf);
|
|
/* amp simulator */
|
|
info->amp_sim = &Reverb::do_dummy_clipping;
|
|
if (info->amp_sw == 1) {
|
|
if (info->amp_type <= 3) {info->amp_sim = &Reverb::do_soft_clipping2;}
|
|
}
|
|
/* waveshaper */
|
|
info->di = TIM_FSCALE(calc_gs_drive(info->drive), 24);
|
|
info->leveli = TIM_FSCALE(info->level * OD_LEVEL_GS, 24);
|
|
/* anti-aliasing */
|
|
lpf1->freq = 8000.0;
|
|
lpf1->q = 1.0;
|
|
calc_filter_biquad_low(lpf1);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
for(i = 0; i < count; i+=2) {
|
|
input = (buf[i] + buf[i + 1]) >> 1;
|
|
/* amp simulation */
|
|
(this->*do_amp_sim)(&input, asdi);
|
|
/* decomposition */
|
|
do_filter_moog(&input, &high, svf->f, svf->p, svf->q,
|
|
&svf->b0, &svf->b1, &svf->b2, &svf->b3, &svf->b4);
|
|
/* waveshaping */
|
|
do_soft_clipping1(&high, di);
|
|
/* anti-aliasing */
|
|
do_filter_biquad(&high, lpf1->a1, lpf1->a2, lpf1->b1, lpf1->b02, &lpf1->x1l, &lpf1->x2l, &lpf1->y1l, &lpf1->y2l);
|
|
/* mixing */
|
|
input = imuldiv24(high + input, leveli);
|
|
buf[i] = do_left_panning(input, pan);
|
|
buf[i + 1] = do_right_panning(input, pan);
|
|
}
|
|
}
|
|
|
|
/*! GS 0x0111: Distortion 1 */
|
|
void Reverb::do_distortion1(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
InfoOverdrive1 *info = (InfoOverdrive1 *)ef->info;
|
|
filter_moog *svf = &(info->svf);
|
|
filter_biquad *lpf1 = &(info->lpf1);
|
|
void (Reverb::*do_amp_sim)(int32_t *, int32_t) = info->amp_sim;
|
|
int32_t i, input, high, leveli = info->leveli, di = info->di,
|
|
pan = info->pan, asdi = TIM_FSCALE(1.0, 24);
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
/* decompositor */
|
|
svf->freq = 500;
|
|
svf->res_dB = 0;
|
|
calc_filter_moog(svf);
|
|
init_filter_moog(svf);
|
|
/* amp simulator */
|
|
info->amp_sim = &Reverb::do_dummy_clipping;
|
|
if (info->amp_sw == 1) {
|
|
if (info->amp_type <= 3) {info->amp_sim = &Reverb::do_soft_clipping2;}
|
|
}
|
|
/* waveshaper */
|
|
info->di = TIM_FSCALE(calc_gs_drive(info->drive), 24);
|
|
info->leveli = TIM_FSCALE(info->level * OD_LEVEL_GS, 24);
|
|
/* anti-aliasing */
|
|
lpf1->freq = 8000.0;
|
|
lpf1->q = 1.0;
|
|
calc_filter_biquad_low(lpf1);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
for(i = 0; i < count; i+=2) {
|
|
input = (buf[i] + buf[i + 1]) >> 1;
|
|
/* amp simulation */
|
|
(this->*do_amp_sim)(&input, asdi);
|
|
/* decomposition */
|
|
do_filter_moog(&input, &high, svf->f, svf->p, svf->q,
|
|
&svf->b0, &svf->b1, &svf->b2, &svf->b3, &svf->b4);
|
|
/* waveshaping */
|
|
do_hard_clipping(&high, di);
|
|
/* anti-aliasing */
|
|
do_filter_biquad(&high, lpf1->a1, lpf1->a2, lpf1->b1, lpf1->b02, &lpf1->x1l, &lpf1->x2l, &lpf1->y1l, &lpf1->y2l);
|
|
/* mixing */
|
|
input = imuldiv24(high + input, leveli);
|
|
buf[i] = do_left_panning(input, pan);
|
|
buf[i + 1] = do_right_panning(input, pan);
|
|
}
|
|
}
|
|
|
|
/*! GS 0x1103: OD1 / OD2 */
|
|
void Reverb::do_dual_od(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
InfoOD1OD2 *info = (InfoOD1OD2 *)ef->info;
|
|
filter_moog *svfl = &(info->svfl), *svfr = &(info->svfr);
|
|
filter_biquad *lpf1 = &(info->lpf1);
|
|
void (Reverb::*do_amp_siml)(int32_t *, int32_t) = info->amp_siml,
|
|
(Reverb::*do_odl)(int32_t *, int32_t) = info->odl,
|
|
(Reverb::*do_odr)(int32_t *, int32_t) = info->odr;
|
|
int32_t i, inputl, inputr, high, levelli = info->levelli, levelri = info->levelri,
|
|
dli = info->dli, dri = info->dri, panl = info->panl, panr = info->panr, asdi = TIM_FSCALE(1.0, 24);
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
/* left */
|
|
/* decompositor */
|
|
svfl->freq = 500;
|
|
svfl->res_dB = 0;
|
|
calc_filter_moog(svfl);
|
|
init_filter_moog(svfl);
|
|
/* amp simulator */
|
|
info->amp_siml = &Reverb::do_dummy_clipping;
|
|
if (info->amp_swl == 1) {
|
|
if (info->amp_typel <= 3) {info->amp_siml = &Reverb::do_soft_clipping2;}
|
|
}
|
|
/* waveshaper */
|
|
if(info->typel == 0) {info->odl = &Reverb::do_soft_clipping1;}
|
|
else {info->odl = &Reverb::do_hard_clipping;}
|
|
info->dli = TIM_FSCALE(calc_gs_drive(info->drivel), 24);
|
|
info->levelli = TIM_FSCALE(info->levell * OD_LEVEL_GS, 24);
|
|
/* right */
|
|
/* decompositor */
|
|
svfr->freq = 500;
|
|
svfr->res_dB = 0;
|
|
calc_filter_moog(svfr);
|
|
init_filter_moog(svfr);
|
|
/* amp simulator */
|
|
info->amp_simr = &Reverb::do_dummy_clipping;
|
|
if (info->amp_swr == 1) {
|
|
if (info->amp_typer <= 3) {info->amp_simr = &Reverb::do_soft_clipping2;}
|
|
}
|
|
/* waveshaper */
|
|
if(info->typer == 0) {info->odr = &Reverb::do_soft_clipping1;}
|
|
else {info->odr = &Reverb::do_hard_clipping;}
|
|
info->dri = TIM_FSCALE(calc_gs_drive(info->driver), 24);
|
|
info->levelri = TIM_FSCALE(info->levelr * OD_LEVEL_GS, 24);
|
|
/* anti-aliasing */
|
|
lpf1->freq = 8000.0;
|
|
lpf1->q = 1.0;
|
|
calc_filter_biquad_low(lpf1);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
for(i = 0; i < count; i++) {
|
|
/* left */
|
|
inputl = buf[i];
|
|
/* amp simulation */
|
|
(this->*do_amp_siml)(&inputl, asdi);
|
|
/* decomposition */
|
|
do_filter_moog(&inputl, &high, svfl->f, svfl->p, svfl->q,
|
|
&svfl->b0, &svfl->b1, &svfl->b2, &svfl->b3, &svfl->b4);
|
|
/* waveshaping */
|
|
(this->*do_odl)(&high, dli);
|
|
/* anti-aliasing */
|
|
do_filter_biquad(&high, lpf1->a1, lpf1->a2, lpf1->b1, lpf1->b02, &lpf1->x1l, &lpf1->x2l, &lpf1->y1l, &lpf1->y2l);
|
|
inputl = imuldiv24(high + inputl, levelli);
|
|
|
|
/* right */
|
|
inputr = buf[++i];
|
|
/* amp simulation */
|
|
(this->*do_amp_siml)(&inputr, asdi);
|
|
/* decomposition */
|
|
do_filter_moog(&inputr, &high, svfr->f, svfr->p, svfr->q,
|
|
&svfr->b0, &svfr->b1, &svfr->b2, &svfr->b3, &svfr->b4);
|
|
/* waveshaping */
|
|
(this->*do_odr)(&high, dri);
|
|
/* anti-aliasing */
|
|
do_filter_biquad(&high, lpf1->a1, lpf1->a2, lpf1->b1, lpf1->b02, &lpf1->x1r, &lpf1->x2r, &lpf1->y1r, &lpf1->y2r);
|
|
inputr = imuldiv24(high + inputr, levelri);
|
|
|
|
/* panning */
|
|
buf[i - 1] = do_left_panning(inputl, panl) + do_left_panning(inputr, panr);
|
|
buf[i] = do_right_panning(inputl, panl) + do_right_panning(inputr, panr);
|
|
}
|
|
}
|
|
|
|
#define HEXA_CHORUS_WET_LEVEL 0.2
|
|
#define HEXA_CHORUS_DEPTH_DEV (1.0 / (20.0 + 1.0))
|
|
#define HEXA_CHORUS_DELAY_DEV (1.0 / (20.0 * 3.0))
|
|
|
|
/*! GS 0x0140: HEXA-CHORUS */
|
|
void Reverb::do_hexa_chorus(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
InfoHexaChorus *info = (InfoHexaChorus *)ef->info;
|
|
lfo *lfo = &(info->lfo0);
|
|
simple_delay *buf0 = &(info->buf0);
|
|
int32_t *ebuf = buf0->buf, size = buf0->size, index = buf0->index;
|
|
int32_t spt0 = info->spt0, spt1 = info->spt1, spt2 = info->spt2,
|
|
spt3 = info->spt3, spt4 = info->spt4, spt5 = info->spt5,
|
|
hist0 = info->hist0, hist1 = info->hist1, hist2 = info->hist2,
|
|
hist3 = info->hist3, hist4 = info->hist4, hist5 = info->hist5;
|
|
int32_t dryi = info->dryi, weti = info->weti;
|
|
int32_t pan0 = info->pan0, pan1 = info->pan1, pan2 = info->pan2,
|
|
pan3 = info->pan3, pan4 = info->pan4, pan5 = info->pan5;
|
|
int32_t depth0 = info->depth0, depth1 = info->depth1, depth2 = info->depth2,
|
|
depth3 = info->depth3, depth4 = info->depth4, depth5 = info->depth5,
|
|
pdelay0 = info->pdelay0, pdelay1 = info->pdelay1, pdelay2 = info->pdelay2,
|
|
pdelay3 = info->pdelay3, pdelay4 = info->pdelay4, pdelay5 = info->pdelay5;
|
|
int32_t i, lfo_val,
|
|
v0, v1, v2, v3, v4, v5, f0, f1, f2, f3, f4, f5;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
set_delay(buf0, (int32_t)(9600.0 * playback_rate / 44100.0));
|
|
init_lfo(lfo, lfo->freq, LFO_TRIANGULAR, 0);
|
|
info->dryi = TIM_FSCALE(info->level * info->dry, 24);
|
|
info->weti = TIM_FSCALE(info->level * info->wet * HEXA_CHORUS_WET_LEVEL, 24);
|
|
v0 = info->depth * ((double)info->depth_dev * HEXA_CHORUS_DEPTH_DEV);
|
|
info->depth0 = info->depth - v0;
|
|
info->depth1 = info->depth;
|
|
info->depth2 = info->depth + v0;
|
|
info->depth3 = info->depth + v0;
|
|
info->depth4 = info->depth;
|
|
info->depth5 = info->depth - v0;
|
|
v0 = info->pdelay * ((double)info->pdelay_dev * HEXA_CHORUS_DELAY_DEV);
|
|
info->pdelay0 = info->pdelay + v0;
|
|
info->pdelay1 = info->pdelay + v0 * 2;
|
|
info->pdelay2 = info->pdelay + v0 * 3;
|
|
info->pdelay3 = info->pdelay + v0 * 3;
|
|
info->pdelay4 = info->pdelay + v0 * 2;
|
|
info->pdelay5 = info->pdelay + v0;
|
|
/* in this part, validation check may be necessary. */
|
|
info->pan0 = 64 - info->pan_dev * 3;
|
|
info->pan1 = 64 - info->pan_dev * 2;
|
|
info->pan2 = 64 - info->pan_dev;
|
|
info->pan3 = 64 + info->pan_dev;
|
|
info->pan4 = 64 + info->pan_dev * 2;
|
|
info->pan5 = 64 + info->pan_dev * 3;
|
|
info->hist0 = info->hist1 = info->hist2
|
|
= info->hist3 = info->hist4 = info->hist5 = 0;
|
|
info->spt0 = info->spt1 = info->spt2
|
|
= info->spt3 = info->spt4 = info->spt5 = 0;
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_delay(buf0);
|
|
return;
|
|
}
|
|
|
|
/* LFO */
|
|
lfo_val = lfo->buf[imuldiv24(lfo->count, lfo->icycle)];
|
|
f0 = imuldiv24(lfo_val, depth0);
|
|
spt0 = index - pdelay0 - (f0 >> 8); /* integral part of delay */
|
|
if(spt0 < 0) {spt0 += size;}
|
|
f1 = imuldiv24(lfo_val, depth1);
|
|
spt1 = index - pdelay1 - (f1 >> 8); /* integral part of delay */
|
|
if(spt1 < 0) {spt1 += size;}
|
|
f2 = imuldiv24(lfo_val, depth2);
|
|
spt2 = index - pdelay2 - (f2 >> 8); /* integral part of delay */
|
|
if(spt2 < 0) {spt2 += size;}
|
|
f3 = imuldiv24(lfo_val, depth3);
|
|
spt3 = index - pdelay3 - (f3 >> 8); /* integral part of delay */
|
|
if(spt3 < 0) {spt3 += size;}
|
|
f4 = imuldiv24(lfo_val, depth4);
|
|
spt4 = index - pdelay4 - (f4 >> 8); /* integral part of delay */
|
|
if(spt4 < 0) {spt4 += size;}
|
|
f5 = imuldiv24(lfo_val, depth5);
|
|
spt5 = index - pdelay5 - (f5 >> 8); /* integral part of delay */
|
|
if(spt5 < 0) {spt5 += size;}
|
|
|
|
for(i = 0; i < count; i+=2) {
|
|
v0 = ebuf[spt0], v1 = ebuf[spt1], v2 = ebuf[spt2],
|
|
v3 = ebuf[spt3], v4 = ebuf[spt4], v5 = ebuf[spt5];
|
|
|
|
/* LFO */
|
|
if(++index == size) {index = 0;}
|
|
lfo_val = do_lfo(lfo);
|
|
f0 = imuldiv24(lfo_val, depth0);
|
|
spt0 = index - pdelay0 - (f0 >> 8); /* integral part of delay */
|
|
f0 = 0xFF - (f0 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt0 < 0) {spt0 += size;}
|
|
f1 = imuldiv24(lfo_val, depth1);
|
|
spt1 = index - pdelay1 - (f1 >> 8); /* integral part of delay */
|
|
f1 = 0xFF - (f1 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt1 < 0) {spt1 += size;}
|
|
f2 = imuldiv24(lfo_val, depth2);
|
|
spt2 = index - pdelay2 - (f2 >> 8); /* integral part of delay */
|
|
f2 = 0xFF - (f2 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt2 < 0) {spt2 += size;}
|
|
f3 = imuldiv24(lfo_val, depth3);
|
|
spt3 = index - pdelay3 - (f3 >> 8); /* integral part of delay */
|
|
f3 = 0xFF - (f3 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt3 < 0) {spt3 += size;}
|
|
f4 = imuldiv24(lfo_val, depth4);
|
|
spt4 = index - pdelay4 - (f4 >> 8); /* integral part of delay */
|
|
f4 = 0xFF - (f4 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt4 < 0) {spt4 += size;}
|
|
f5 = imuldiv24(lfo_val, depth5);
|
|
spt5 = index - pdelay5 - (f5 >> 8); /* integral part of delay */
|
|
f5 = 0xFF - (f5 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt5 < 0) {spt5 += size;}
|
|
|
|
/* chorus effect */
|
|
/* all-pass interpolation */
|
|
hist0 = v0 + imuldiv8(ebuf[spt0] - hist0, f0);
|
|
hist1 = v1 + imuldiv8(ebuf[spt1] - hist1, f1);
|
|
hist2 = v2 + imuldiv8(ebuf[spt2] - hist2, f2);
|
|
hist3 = v3 + imuldiv8(ebuf[spt3] - hist3, f3);
|
|
hist4 = v4 + imuldiv8(ebuf[spt4] - hist4, f4);
|
|
hist5 = v5 + imuldiv8(ebuf[spt5] - hist5, f5);
|
|
ebuf[index] = imuldiv24(buf[i] + buf[i + 1], weti);
|
|
|
|
/* mixing */
|
|
buf[i] = do_left_panning(hist0, pan0) + do_left_panning(hist1, pan1)
|
|
+ do_left_panning(hist2, pan2) + do_left_panning(hist3, pan3)
|
|
+ do_left_panning(hist4, pan4) + do_left_panning(hist5, pan5)
|
|
+ imuldiv24(buf[i], dryi);
|
|
buf[i + 1] = do_right_panning(hist0, pan0) + do_right_panning(hist1, pan1)
|
|
+ do_right_panning(hist2, pan2) + do_right_panning(hist3, pan3)
|
|
+ do_right_panning(hist4, pan4) + do_right_panning(hist5, pan5)
|
|
+ imuldiv24(buf[i + 1], dryi);
|
|
|
|
}
|
|
buf0->size = size, buf0->index = index;
|
|
info->spt0 = spt0, info->spt1 = spt1, info->spt2 = spt2,
|
|
info->spt3 = spt3, info->spt4 = spt4, info->spt5 = spt5,
|
|
info->hist0 = hist0, info->hist1 = hist1, info->hist2 = hist2,
|
|
info->hist3 = hist3, info->hist4 = hist4, info->hist5 = hist5;
|
|
}
|
|
|
|
void Reverb::free_effect_xg(struct effect_xg_t *st)
|
|
{
|
|
free_effect_list(st->ef);
|
|
st->ef = NULL;
|
|
}
|
|
|
|
void Reverb::free_effect_buffers(void)
|
|
{
|
|
int i;
|
|
/* free GM/GS/GM2 effects */
|
|
do_ch_standard_reverb(NULL, MAGIC_FREE_EFFECT_INFO, &(reverb_status_gs.info_standard_reverb));
|
|
do_ch_freeverb(NULL, MAGIC_FREE_EFFECT_INFO, &(reverb_status_gs.info_freeverb));
|
|
do_ch_plate_reverb(NULL, MAGIC_FREE_EFFECT_INFO, &(reverb_status_gs.info_plate_reverb));
|
|
do_ch_reverb_normal_delay(NULL, MAGIC_FREE_EFFECT_INFO, &(reverb_status_gs.info_reverb_delay));
|
|
do_ch_stereo_chorus(NULL, MAGIC_FREE_EFFECT_INFO, &(chorus_status_gs.info_stereo_chorus));
|
|
do_ch_3tap_delay(NULL, MAGIC_FREE_EFFECT_INFO, &(delay_status_gs.info_delay));
|
|
free_effect_list(insertion_effect_gs.ef);
|
|
insertion_effect_gs.ef = NULL;
|
|
/* free XG effects */
|
|
free_effect_xg(&reverb_status_xg);
|
|
free_effect_xg(&chorus_status_xg);
|
|
for (i = 0; i < XG_VARIATION_EFFECT_NUM; i++) {
|
|
free_effect_xg(&variation_effect_xg[i]);
|
|
}
|
|
for (i = 0; i < XG_INSERTION_EFFECT_NUM; i++) {
|
|
free_effect_xg(&insertion_effect_xg[i]);
|
|
}
|
|
}
|
|
|
|
int Reverb::clip_int(int val, int min, int max)
|
|
{
|
|
return ((val > max) ? max : (val < min) ? min : val);
|
|
}
|
|
|
|
void Reverb::conv_gs_eq2(struct insertion_effect_gs_t *ieffect, EffectList *ef)
|
|
{
|
|
InfoEQ2 *eq = (InfoEQ2 *)ef->info;
|
|
|
|
eq->high_freq = 4000;
|
|
eq->high_gain = clip_int(ieffect->parameter[16] - 0x40, -12, 12);
|
|
eq->low_freq = 400;
|
|
eq->low_gain = clip_int(ieffect->parameter[17] - 0x40, -12, 12);
|
|
}
|
|
|
|
void Reverb::conv_gs_overdrive1(struct insertion_effect_gs_t *ieffect, EffectList *ef)
|
|
{
|
|
InfoOverdrive1 *od = (InfoOverdrive1 *)ef->info;
|
|
|
|
od->drive = ieffect->parameter[0];
|
|
od->amp_type = ieffect->parameter[1];
|
|
od->amp_sw = ieffect->parameter[2];
|
|
od->pan = ieffect->parameter[18];
|
|
od->level = (double)ieffect->parameter[19] / 127.0;
|
|
}
|
|
|
|
void Reverb::conv_gs_dual_od(struct insertion_effect_gs_t *ieffect, EffectList *ef)
|
|
{
|
|
InfoOD1OD2 *od = (InfoOD1OD2 *)ef->info;
|
|
|
|
od->typel = ieffect->parameter[0];
|
|
od->drivel = ieffect->parameter[1];
|
|
od->amp_typel = ieffect->parameter[2];
|
|
od->amp_swl = ieffect->parameter[3];
|
|
od->typer = ieffect->parameter[5];
|
|
od->driver = ieffect->parameter[6];
|
|
od->amp_typer = ieffect->parameter[7];
|
|
od->amp_swr = ieffect->parameter[8];
|
|
od->panl = ieffect->parameter[15];
|
|
od->levell = (double)ieffect->parameter[16] / 127.0;
|
|
od->panr = ieffect->parameter[17];
|
|
od->levelr = (double)ieffect->parameter[18] / 127.0;
|
|
od->level = (double)ieffect->parameter[19] / 127.0;
|
|
}
|
|
|
|
double Reverb::calc_dry_gs(int val)
|
|
{
|
|
return ((double)(127 - val) / 127.0);
|
|
}
|
|
|
|
double Reverb::calc_wet_gs(int val)
|
|
{
|
|
return ((double)val / 127.0);
|
|
}
|
|
|
|
void Reverb::conv_gs_hexa_chorus(struct insertion_effect_gs_t *ieffect, EffectList *ef)
|
|
{
|
|
InfoHexaChorus *info = (InfoHexaChorus *)ef->info;
|
|
|
|
info->level = (double)ieffect->parameter[19] / 127.0;
|
|
info->pdelay = pre_delay_time_table[ieffect->parameter[0]] * (double)playback_rate / 1000.0;
|
|
info->depth = (double)(ieffect->parameter[2] + 1) / 3.2 * (double)playback_rate / 1000.0;
|
|
info->pdelay -= info->depth / 2;
|
|
if(info->pdelay <= 1) {info->pdelay = 1;}
|
|
info->lfo0.freq = rate1_table[ieffect->parameter[1]];
|
|
info->pdelay_dev = ieffect->parameter[3];
|
|
info->depth_dev = ieffect->parameter[4] - 64;
|
|
info->pan_dev = ieffect->parameter[5];
|
|
info->dry = calc_dry_gs(ieffect->parameter[15]);
|
|
info->wet = calc_wet_gs(ieffect->parameter[15]);
|
|
}
|
|
|
|
double Reverb::calc_dry_xg(int val, struct effect_xg_t *st)
|
|
{
|
|
if (st->connection) {return 0.0;}
|
|
else {return ((double)(127 - val) / 127.0);}
|
|
}
|
|
|
|
double Reverb::calc_wet_xg(int val, struct effect_xg_t *st)
|
|
{
|
|
switch(st->connection) {
|
|
case XG_CONN_SYSTEM:
|
|
return ((double)st->ret / 127.0);
|
|
case XG_CONN_SYSTEM_CHORUS:
|
|
return ((double)st->ret / 127.0);
|
|
case XG_CONN_SYSTEM_REVERB:
|
|
return ((double)st->ret / 127.0);
|
|
default:
|
|
return ((double)val / 127.0);
|
|
}
|
|
}
|
|
|
|
/*! 3-Band EQ */
|
|
void Reverb::do_eq3(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
InfoEQ3 *eq = (InfoEQ3 *)ef->info;
|
|
if (count == MAGIC_INIT_EFFECT_INFO) {
|
|
eq->lsf.q = 0;
|
|
eq->lsf.freq = eq->low_freq;
|
|
eq->lsf.gain = eq->low_gain;
|
|
calc_filter_shelving_low(&(eq->lsf));
|
|
eq->hsf.q = 0;
|
|
eq->hsf.freq = eq->high_freq;
|
|
eq->hsf.gain = eq->high_gain;
|
|
calc_filter_shelving_high(&(eq->hsf));
|
|
eq->peak.q = 1.0 / eq->mid_width;
|
|
eq->peak.freq = eq->mid_freq;
|
|
eq->peak.gain = eq->mid_gain;
|
|
calc_filter_peaking(&(eq->peak));
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
if (eq->low_gain != 0) {
|
|
do_shelving_filter_stereo(buf, count, &(eq->lsf));
|
|
}
|
|
if (eq->high_gain != 0) {
|
|
do_shelving_filter_stereo(buf, count, &(eq->hsf));
|
|
}
|
|
if (eq->mid_gain != 0) {
|
|
do_peaking_filter_stereo(buf, count, &(eq->peak));
|
|
}
|
|
}
|
|
|
|
/*! Stereo EQ */
|
|
void Reverb::do_stereo_eq(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
InfoStereoEQ *eq = (InfoStereoEQ *)ef->info;
|
|
int32_t i, leveli = eq->leveli;
|
|
if (count == MAGIC_INIT_EFFECT_INFO) {
|
|
eq->lsf.q = 0;
|
|
eq->lsf.freq = eq->low_freq;
|
|
eq->lsf.gain = eq->low_gain;
|
|
calc_filter_shelving_low(&(eq->lsf));
|
|
eq->hsf.q = 0;
|
|
eq->hsf.freq = eq->high_freq;
|
|
eq->hsf.gain = eq->high_gain;
|
|
calc_filter_shelving_high(&(eq->hsf));
|
|
eq->m1.q = eq->m1_q;
|
|
eq->m1.freq = eq->m1_freq;
|
|
eq->m1.gain = eq->m1_gain;
|
|
calc_filter_peaking(&(eq->m1));
|
|
eq->m2.q = eq->m2_q;
|
|
eq->m2.freq = eq->m2_freq;
|
|
eq->m2.gain = eq->m2_gain;
|
|
calc_filter_peaking(&(eq->m2));
|
|
eq->leveli = TIM_FSCALE(eq->level, 24);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
if (eq->level != 1.0) {
|
|
for (i = 0; i < count; i++) {
|
|
buf[i] = imuldiv24(buf[i], leveli);
|
|
}
|
|
}
|
|
if (eq->low_gain != 0) {
|
|
do_shelving_filter_stereo(buf, count, &(eq->lsf));
|
|
}
|
|
if (eq->high_gain != 0) {
|
|
do_shelving_filter_stereo(buf, count, &(eq->hsf));
|
|
}
|
|
if (eq->m1_gain != 0) {
|
|
do_peaking_filter_stereo(buf, count, &(eq->m1));
|
|
}
|
|
if (eq->m2_gain != 0) {
|
|
do_peaking_filter_stereo(buf, count, &(eq->m2));
|
|
}
|
|
}
|
|
|
|
void Reverb::conv_xg_eq2(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoEQ2 *info = (InfoEQ2 *)ef->info;
|
|
|
|
info->low_freq = eq_freq_table_xg[clip_int(st->param_lsb[0], 4, 40)];
|
|
info->low_gain = clip_int(st->param_lsb[1] - 64, -12, 12);
|
|
info->high_freq = eq_freq_table_xg[clip_int(st->param_lsb[2], 28, 58)];
|
|
info->high_gain = clip_int(st->param_lsb[3] - 64, -12, 12);
|
|
}
|
|
|
|
void Reverb::conv_xg_eq3(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoEQ3 *info = (InfoEQ3 *)ef->info;
|
|
|
|
info->low_gain = clip_int(st->param_lsb[0] - 64, -12, 12);
|
|
info->mid_freq = eq_freq_table_xg[clip_int(st->param_lsb[1], 14, 54)];
|
|
info->mid_gain = clip_int(st->param_lsb[2] - 64, -12, 12);
|
|
info->mid_width = (double)clip_int(st->param_lsb[3], 10, 120) / 10.0;
|
|
info->high_gain = clip_int(st->param_lsb[4] - 64, -12, 12);
|
|
info->low_freq = eq_freq_table_xg[clip_int(st->param_lsb[5], 4, 40)];
|
|
info->high_freq = eq_freq_table_xg[clip_int(st->param_lsb[6], 28, 58)];
|
|
}
|
|
|
|
static const float eq_q_table_gs[] =
|
|
{
|
|
0.5, 1.0, 2.0, 4.0, 9.0,
|
|
};
|
|
|
|
void Reverb::conv_gs_stereo_eq(struct insertion_effect_gs_t *st, EffectList *ef)
|
|
{
|
|
InfoStereoEQ *info = (InfoStereoEQ *)ef->info;
|
|
|
|
info->low_freq = (st->parameter[0] == 0) ? 200 : 400;
|
|
info->low_gain = clip_int(st->parameter[1] - 64, -12, 12);
|
|
info->high_freq = (st->parameter[2] == 0) ? 4000 : 8000;
|
|
info->high_gain = clip_int(st->parameter[3] - 64, -12, 12);
|
|
info->m1_freq = eq_freq_table_gs[st->parameter[4]];
|
|
info->m1_q = eq_q_table_gs[clip_int(st->parameter[5], 0, 4)];
|
|
info->m1_gain = clip_int(st->parameter[6] - 64, -12, 12);
|
|
info->m2_freq = eq_freq_table_gs[st->parameter[7]];
|
|
info->m2_q = eq_q_table_gs[clip_int(st->parameter[8], 0, 4)];
|
|
info->m2_gain = clip_int(st->parameter[9] - 64, -12, 12);
|
|
info->level = (double)st->parameter[19] / 127.0;
|
|
}
|
|
|
|
void Reverb::conv_xg_chorus_eq3(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoEQ3 *info = (InfoEQ3 *)ef->info;
|
|
|
|
info->low_freq = eq_freq_table_xg[clip_int(st->param_lsb[5], 4, 40)];
|
|
info->low_gain = clip_int(st->param_lsb[6] - 64, -12, 12);
|
|
info->high_freq = eq_freq_table_xg[clip_int(st->param_lsb[7], 28, 58)];
|
|
info->high_gain = clip_int(st->param_lsb[8] - 64, -12, 12);
|
|
info->mid_freq = eq_freq_table_xg[clip_int(st->param_lsb[10], 14, 54)];
|
|
info->mid_gain = clip_int(st->param_lsb[11] - 64, -12, 12);
|
|
info->mid_width = (double)clip_int(st->param_lsb[12], 10, 120) / 10.0;
|
|
}
|
|
|
|
void Reverb::conv_xg_chorus(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoChorus *info = (InfoChorus *)ef->info;
|
|
|
|
info->rate = lfo_freq_table_xg[st->param_lsb[0]];
|
|
info->depth_ms = (double)(st->param_lsb[1] + 1) / 3.2 / 2.0;
|
|
info->feedback = (double)(st->param_lsb[2] - 64) * (0.763 * 2.0 / 100.0);
|
|
info->pdelay_ms = mod_delay_offset_table_xg[st->param_lsb[3]];
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
info->phase_diff = 90.0;
|
|
}
|
|
|
|
void Reverb::conv_xg_flanger(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoChorus *info = (InfoChorus *)ef->info;
|
|
|
|
info->rate = lfo_freq_table_xg[st->param_lsb[0]];
|
|
info->depth_ms = (double)(st->param_lsb[1] + 1) / 3.2 / 2.0;
|
|
info->feedback = (double)(st->param_lsb[2] - 64) * (0.763 * 2.0 / 100.0);
|
|
info->pdelay_ms = mod_delay_offset_table_xg[st->param_lsb[2]];
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
info->phase_diff = (double)(clip_int(st->param_lsb[13], 4, 124) - 64) * 3.0;
|
|
}
|
|
|
|
void Reverb::conv_xg_symphonic(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoChorus *info = (InfoChorus *)ef->info;
|
|
|
|
info->rate = lfo_freq_table_xg[st->param_lsb[0]];
|
|
info->depth_ms = (double)(st->param_lsb[1] + 1) / 3.2 / 2.0;
|
|
info->feedback = 0.0;
|
|
info->pdelay_ms = mod_delay_offset_table_xg[st->param_lsb[3]];
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
info->phase_diff = 90.0;
|
|
}
|
|
|
|
void Reverb::do_chorus(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
InfoChorus *info = (InfoChorus *)ef->info;
|
|
int32_t i, output, f0, f1, v0, v1;
|
|
int32_t *bufL = info->delayL.buf, *bufR = info->delayR.buf,
|
|
*lfobufL = info->lfoL.buf, *lfobufR = info->lfoR.buf,
|
|
icycle = info->lfoL.icycle, cycle = info->lfoL.cycle,
|
|
dryi = info->dryi, weti = info->weti, feedbacki = info->feedbacki,
|
|
depth = info->depth, pdelay = info->pdelay, rpt0 = info->rpt0;
|
|
int32_t wpt0 = info->wpt0, spt0 = info->spt0, spt1 = info->spt1,
|
|
hist0 = info->hist0, hist1 = info->hist1, lfocnt = info->lfoL.count;
|
|
|
|
if (count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_lfo(&(info->lfoL), info->rate, LFO_TRIANGULAR, 0);
|
|
init_lfo(&(info->lfoR), info->rate, LFO_TRIANGULAR, info->phase_diff);
|
|
info->pdelay = info->pdelay_ms * (double)playback_rate / 1000.0;
|
|
info->depth = info->depth_ms * (double)playback_rate / 1000.0;
|
|
info->pdelay -= info->depth / 2; /* NOMINAL_DELAY to delay */
|
|
if (info->pdelay < 1) {info->pdelay = 1;}
|
|
info->rpt0 = info->pdelay + info->depth + 2; /* allowance */
|
|
set_delay(&(info->delayL), info->rpt0);
|
|
set_delay(&(info->delayR), info->rpt0);
|
|
info->feedbacki = TIM_FSCALE(info->feedback, 24);
|
|
info->dryi = TIM_FSCALE(info->dry, 24);
|
|
info->weti = TIM_FSCALE(info->wet, 24);
|
|
info->wpt0 = info->spt0 = info->spt1 = info->hist0 = info->hist1 = 0;
|
|
return;
|
|
} else if (count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_delay(&(info->delayL));
|
|
free_delay(&(info->delayR));
|
|
return;
|
|
}
|
|
|
|
/* LFO */
|
|
f0 = imuldiv24(lfobufL[imuldiv24(lfocnt, icycle)], depth);
|
|
spt0 = wpt0 - pdelay - (f0 >> 8); /* integral part of delay */
|
|
f0 = 0xFF - (f0 & 0xFF); /* (1 - frac) * 256 */
|
|
if (spt0 < 0) {spt0 += rpt0;}
|
|
f1 = imuldiv24(lfobufR[imuldiv24(lfocnt, icycle)], depth);
|
|
spt1 = wpt0 - pdelay - (f1 >> 8); /* integral part of delay */
|
|
f1 = 0xFF - (f1 & 0xFF); /* (1 - frac) * 256 */
|
|
if (spt1 < 0) {spt1 += rpt0;}
|
|
|
|
for (i = 0; i < count; i++) {
|
|
v0 = bufL[spt0];
|
|
v1 = bufR[spt1];
|
|
|
|
/* LFO */
|
|
if(++wpt0 == rpt0) {wpt0 = 0;}
|
|
f0 = imuldiv24(lfobufL[imuldiv24(lfocnt, icycle)], depth);
|
|
spt0 = wpt0 - pdelay - (f0 >> 8); /* integral part of delay */
|
|
f0 = 0xFF - (f0 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt0 < 0) {spt0 += rpt0;}
|
|
f1 = imuldiv24(lfobufR[imuldiv24(lfocnt, icycle)], depth);
|
|
spt1 = wpt0 - pdelay - (f1 >> 8); /* integral part of delay */
|
|
f1 = 0xFF - (f1 & 0xFF); /* (1 - frac) * 256 */
|
|
if(spt1 < 0) {spt1 += rpt0;}
|
|
if(++lfocnt == cycle) {lfocnt = 0;}
|
|
|
|
/* left */
|
|
/* delay with all-pass interpolation */
|
|
output = hist0 = v0 + imuldiv8(bufL[spt0] - hist0, f0);
|
|
bufL[wpt0] = buf[i] + imuldiv24(output, feedbacki);
|
|
buf[i] = imuldiv24(buf[i], dryi) + imuldiv24(output, weti);
|
|
|
|
/* right */
|
|
/* delay with all-pass interpolation */
|
|
output = hist1 = v1 + imuldiv8(bufR[spt1] - hist1, f1);
|
|
bufR[wpt0] = buf[++i] + imuldiv24(output, feedbacki);
|
|
buf[i] = imuldiv24(buf[i], dryi) + imuldiv24(output, weti);
|
|
}
|
|
info->wpt0 = wpt0, info->spt0 = spt0, info->spt1 = spt1,
|
|
info->hist0 = hist0, info->hist1 = hist1;
|
|
info->lfoL.count = info->lfoR.count = lfocnt;
|
|
}
|
|
|
|
void Reverb::conv_xg_od_eq3(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoEQ3 *info = (InfoEQ3 *)ef->info;
|
|
|
|
info->low_freq = eq_freq_table_xg[clip_int(st->param_lsb[1], 4, 40)];
|
|
info->low_gain = clip_int(st->param_lsb[2] - 64, -12, 12);
|
|
info->mid_freq = eq_freq_table_xg[clip_int(st->param_lsb[6], 14, 54)];
|
|
info->mid_gain = clip_int(st->param_lsb[7] - 64, -12, 12);
|
|
info->mid_width = (double)clip_int(st->param_lsb[8], 10, 120) / 10.0;
|
|
info->high_freq = 0;
|
|
info->high_gain = 0;
|
|
}
|
|
|
|
void Reverb::conv_xg_overdrive(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoStereoOD *info = (InfoStereoOD *)ef->info;
|
|
|
|
info->od = &Reverb::do_soft_clipping1;
|
|
info->drive = (double)st->param_lsb[0] / 127.0;
|
|
info->cutoff = eq_freq_table_xg[clip_int(st->param_lsb[3], 34, 60)];
|
|
info->level = (double)st->param_lsb[4] / 127.0;
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
}
|
|
|
|
void Reverb::conv_xg_distortion(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoStereoOD *info = (InfoStereoOD *)ef->info;
|
|
|
|
info->od = &Reverb::do_hard_clipping;
|
|
info->drive = (double)st->param_lsb[0] / 127.0;
|
|
info->cutoff = eq_freq_table_xg[clip_int(st->param_lsb[3], 34, 60)];
|
|
info->level = (double)st->param_lsb[4] / 127.0;
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
}
|
|
|
|
void Reverb::conv_xg_amp_simulator(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoStereoOD *info = (InfoStereoOD *)ef->info;
|
|
|
|
info->od = &Reverb::do_soft_clipping2;
|
|
info->drive = (double)st->param_lsb[0] / 127.0;
|
|
info->cutoff = eq_freq_table_xg[clip_int(st->param_lsb[2], 34, 60)];
|
|
info->level = (double)st->param_lsb[3] / 127.0;
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
}
|
|
|
|
void Reverb::do_stereo_od(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
InfoStereoOD *info = (InfoStereoOD *)ef->info;
|
|
filter_moog *svfl = &(info->svfl), *svfr = &(info->svfr);
|
|
filter_biquad *lpf1 = &(info->lpf1);
|
|
void (Reverb::*do_od)(int32_t *, int32_t) = info->od;
|
|
int32_t i, inputl, inputr, high, weti = info->weti, dryi = info->dryi, di = info->di;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
/* decompositor */
|
|
svfl->freq = 500;
|
|
svfl->res_dB = 0;
|
|
calc_filter_moog(svfl);
|
|
init_filter_moog(svfl);
|
|
svfr->freq = 500;
|
|
svfr->res_dB = 0;
|
|
calc_filter_moog(svfr);
|
|
init_filter_moog(svfr);
|
|
/* anti-aliasing */
|
|
lpf1->freq = info->cutoff;
|
|
lpf1->q = 1.0;
|
|
calc_filter_biquad_low(lpf1);
|
|
info->weti = TIM_FSCALE(info->wet * info->level, 24);
|
|
info->dryi = TIM_FSCALE(info->dry * info->level, 24);
|
|
info->di = TIM_FSCALE(calc_gs_drive(info->drive), 24);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
for(i = 0; i < count; i++) {
|
|
/* left */
|
|
inputl = buf[i];
|
|
/* decomposition */
|
|
do_filter_moog(&inputl, &high, svfl->f, svfl->p, svfl->q,
|
|
&svfl->b0, &svfl->b1, &svfl->b2, &svfl->b3, &svfl->b4);
|
|
/* waveshaping */
|
|
(this->*do_od)(&high, di);
|
|
/* anti-aliasing */
|
|
do_filter_biquad(&high, lpf1->a1, lpf1->a2, lpf1->b1, lpf1->b02, &lpf1->x1l, &lpf1->x2l, &lpf1->y1l, &lpf1->y2l);
|
|
buf[i] = imuldiv24(high + inputl, weti) + imuldiv24(buf[i], dryi);
|
|
|
|
/* right */
|
|
inputr = buf[++i];
|
|
/* decomposition */
|
|
do_filter_moog(&inputr, &high, svfr->f, svfr->p, svfr->q,
|
|
&svfr->b0, &svfr->b1, &svfr->b2, &svfr->b3, &svfr->b4);
|
|
/* waveshaping */
|
|
(this->*do_od)(&high, di);
|
|
/* anti-aliasing */
|
|
do_filter_biquad(&high, lpf1->a1, lpf1->a2, lpf1->b1, lpf1->b02, &lpf1->x1r, &lpf1->x2r, &lpf1->y1r, &lpf1->y2r);
|
|
buf[i] = imuldiv24(high + inputr, weti) + imuldiv24(buf[i], dryi);
|
|
}
|
|
}
|
|
|
|
void Reverb::do_delay_lcr(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
int32_t i, x;
|
|
InfoDelayLCR *info = (InfoDelayLCR *)ef->info;
|
|
simple_delay *delayL = &(info->delayL), *delayR = &(info->delayR);
|
|
filter_lowpass1 *lpf = &(info->lpf);
|
|
int32_t *bufL = delayL->buf, *bufR = delayR->buf;
|
|
int32_t buf_index = delayL->index, buf_size = delayL->size;
|
|
int32_t index0 = info->index[0], index1 = info->index[1], index2 = info->index[2],
|
|
x1l = lpf->x1l, x1r = lpf->x1r;
|
|
int32_t cleveli = info->cleveli, feedbacki = info->feedbacki,
|
|
dryi = info->dryi, weti = info->weti, ai = lpf->ai, iai = lpf->iai;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
info->size[0] = info->ldelay * playback_rate / 1000.0;
|
|
info->size[1] = info->cdelay * playback_rate / 1000.0;
|
|
info->size[2] = info->rdelay * playback_rate / 1000.0;
|
|
x = info->fdelay * playback_rate / 1000.0;
|
|
for (i = 0; i < 3; i++) {
|
|
if (info->size[i] > x) {info->size[i] = x;}
|
|
}
|
|
x += 1; /* allowance */
|
|
set_delay(&(info->delayL), x);
|
|
set_delay(&(info->delayR), x);
|
|
for (i = 0; i < 3; i++) { /* set start-point */
|
|
info->index[i] = x - info->size[i];
|
|
}
|
|
info->feedbacki = TIM_FSCALE(info->feedback, 24);
|
|
info->cleveli = TIM_FSCALE(info->clevel, 24);
|
|
info->dryi = TIM_FSCALE(info->dry, 24);
|
|
info->weti = TIM_FSCALE(info->wet, 24);
|
|
lpf->a = (1.0 - info->high_damp) * 44100.0 / playback_rate;
|
|
init_filter_lowpass1(lpf);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_delay(&(info->delayL));
|
|
free_delay(&(info->delayR));
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
x = imuldiv24(bufL[buf_index], feedbacki);
|
|
do_filter_lowpass1(&x, &x1l, ai, iai);
|
|
bufL[buf_index] = buf[i] + x;
|
|
x = bufL[index0] + imuldiv24(bufL[index1], cleveli);
|
|
buf[i] = imuldiv24(buf[i], dryi) + imuldiv24(x, weti);
|
|
|
|
x = imuldiv24(bufR[buf_index], feedbacki);
|
|
do_filter_lowpass1(&x, &x1r, ai, iai);
|
|
bufR[buf_index] = buf[++i] + x;
|
|
x = bufR[index2] + imuldiv24(bufR[index1], cleveli);
|
|
buf[i] = imuldiv24(buf[i], dryi) + imuldiv24(x, weti);
|
|
|
|
if (++index0 == buf_size) {index0 = 0;}
|
|
if (++index1 == buf_size) {index1 = 0;}
|
|
if (++index2 == buf_size) {index2 = 0;}
|
|
if (++buf_index == buf_size) {buf_index = 0;}
|
|
}
|
|
info->index[0] = index0, info->index[1] = index1, info->index[2] = index2;
|
|
lpf->x1l = x1l, lpf->x1r = x1r;
|
|
delayL->index = delayR->index = buf_index;
|
|
}
|
|
|
|
void Reverb::conv_xg_delay_eq2(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoEQ2 *info = (InfoEQ2 *)ef->info;
|
|
|
|
info->low_freq = eq_freq_table_xg[clip_int(st->param_lsb[12], 4, 40)];
|
|
info->low_gain = clip_int(st->param_lsb[13] - 64, -12, 12);
|
|
info->high_freq = eq_freq_table_xg[clip_int(st->param_lsb[14], 28, 58)];
|
|
info->high_gain = clip_int(st->param_lsb[15] - 64, -12, 12);
|
|
}
|
|
|
|
void Reverb::conv_xg_delay_lcr(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoDelayLCR *info = (InfoDelayLCR *)ef->info;
|
|
|
|
info->ldelay = (double)clip_int(st->param_msb[0] * 128 + st->param_lsb[0], 1, 14860) / 10.0;
|
|
info->rdelay = (double)clip_int(st->param_msb[1] * 128 + st->param_lsb[1], 1, 14860) / 10.0;
|
|
info->cdelay = (double)clip_int(st->param_msb[2] * 128 + st->param_lsb[2], 1, 14860) / 10.0;
|
|
info->fdelay = (double)clip_int(st->param_msb[3] * 128 + st->param_lsb[3], 1, 14860) / 10.0;
|
|
info->feedback = (double)(st->param_lsb[4] - 64) * (0.763 * 2.0 / 100.0);
|
|
info->clevel = (double)st->param_lsb[5] / 127.0;
|
|
info->high_damp = (double)clip_int(st->param_lsb[6], 1, 10) / 10.0;
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
}
|
|
|
|
void Reverb::conv_xg_delay_lr(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoDelayLR *info = (InfoDelayLR *)ef->info;
|
|
|
|
info->ldelay = (double)clip_int(st->param_msb[0] * 128 + st->param_lsb[0], 1, 14860) / 10.0;
|
|
info->rdelay = (double)clip_int(st->param_msb[1] * 128 + st->param_lsb[1], 1, 14860) / 10.0;
|
|
info->fdelay1 = (double)clip_int(st->param_msb[2] * 128 + st->param_lsb[2], 1, 14860) / 10.0;
|
|
info->fdelay2 = (double)clip_int(st->param_msb[3] * 128 + st->param_lsb[3], 1, 14860) / 10.0;
|
|
info->feedback = (double)(st->param_lsb[4] - 64) * (0.763 * 2.0 / 100.0);
|
|
info->high_damp = (double)clip_int(st->param_lsb[5], 1, 10) / 10.0;
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
}
|
|
|
|
void Reverb::do_delay_lr(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
int32_t i, x;
|
|
InfoDelayLR *info = (InfoDelayLR *)ef->info;
|
|
simple_delay *delayL = &(info->delayL), *delayR = &(info->delayR);
|
|
filter_lowpass1 *lpf = &(info->lpf);
|
|
int32_t *bufL = delayL->buf, *bufR = delayR->buf;
|
|
int32_t indexl = delayL->index, sizel = delayL->size,
|
|
indexr = delayR->index, sizer = delayR->size;
|
|
int32_t index0 = info->index[0], index1 = info->index[1],
|
|
x1l = lpf->x1l, x1r = lpf->x1r;
|
|
int32_t feedbacki = info->feedbacki,
|
|
dryi = info->dryi, weti = info->weti, ai = lpf->ai, iai = lpf->iai;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
info->size[0] = info->ldelay * playback_rate / 1000.0;
|
|
x = info->fdelay1 * playback_rate / 1000.0;
|
|
if (info->size[0] > x) {info->size[0] = x;}
|
|
x++;
|
|
set_delay(&(info->delayL), x);
|
|
info->index[0] = x - info->size[0];
|
|
info->size[1] = info->rdelay * playback_rate / 1000.0;
|
|
x = info->fdelay2 * playback_rate / 1000.0;
|
|
if (info->size[1] > x) {info->size[1] = x;}
|
|
x++;
|
|
set_delay(&(info->delayR), x);
|
|
info->index[1] = x - info->size[1];
|
|
info->feedbacki = TIM_FSCALE(info->feedback, 24);
|
|
info->dryi = TIM_FSCALE(info->dry, 24);
|
|
info->weti = TIM_FSCALE(info->wet, 24);
|
|
lpf->a = (1.0 - info->high_damp) * 44100.0 / playback_rate;
|
|
init_filter_lowpass1(lpf);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_delay(&(info->delayL));
|
|
free_delay(&(info->delayR));
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
x = imuldiv24(bufL[indexl], feedbacki);
|
|
do_filter_lowpass1(&x, &x1l, ai, iai);
|
|
bufL[indexl] = buf[i] + x;
|
|
buf[i] = imuldiv24(buf[i], dryi) + imuldiv24(bufL[index0], weti);
|
|
|
|
x = imuldiv24(bufR[indexr], feedbacki);
|
|
do_filter_lowpass1(&x, &x1r, ai, iai);
|
|
bufR[indexr] = buf[++i] + x;
|
|
buf[i] = imuldiv24(buf[i], dryi) + imuldiv24(bufR[index1], weti);
|
|
|
|
if (++index0 == sizel) {index0 = 0;}
|
|
if (++index1 == sizer) {index1 = 0;}
|
|
if (++indexl == sizel) {indexl = 0;}
|
|
if (++indexr == sizer) {indexr = 0;}
|
|
}
|
|
info->index[0] = index0, info->index[1] = index1;
|
|
lpf->x1l = x1l, lpf->x1r = x1r;
|
|
delayL->index = indexl, delayR->index = indexr;
|
|
}
|
|
|
|
void Reverb::conv_xg_echo(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoEcho *info = (InfoEcho *)ef->info;
|
|
|
|
info->ldelay1 = (double)clip_int(st->param_msb[0] * 128 + st->param_lsb[0], 1, 7430) / 10.0;
|
|
info->lfeedback = (double)(st->param_lsb[1] - 64) * (0.763 * 2.0 / 100.0);
|
|
info->rdelay1 = (double)clip_int(st->param_msb[2] * 128 + st->param_lsb[2], 1, 7430) / 10.0;
|
|
info->rfeedback = (double)(st->param_lsb[3] - 64) * (0.763 * 2.0 / 100.0);
|
|
info->high_damp = (double)clip_int(st->param_lsb[4], 1, 10) / 10.0;
|
|
info->ldelay2 = (double)clip_int(st->param_msb[5] * 128 + st->param_lsb[5], 1, 7430) / 10.0;
|
|
info->rdelay2 = (double)clip_int(st->param_msb[6] * 128 + st->param_lsb[6], 1, 7430) / 10.0;
|
|
info->level = (double)st->param_lsb[7] / 127.0;
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
}
|
|
|
|
void Reverb::do_echo(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
int32_t i, x, y;
|
|
InfoEcho *info = (InfoEcho *)ef->info;
|
|
simple_delay *delayL = &(info->delayL), *delayR = &(info->delayR);
|
|
filter_lowpass1 *lpf = &(info->lpf);
|
|
int32_t *bufL = delayL->buf, *bufR = delayR->buf;
|
|
int32_t indexl = delayL->index, sizel = delayL->size,
|
|
indexr = delayR->index, sizer = delayR->size;
|
|
int32_t index0 = info->index[0], index1 = info->index[1],
|
|
x1l = lpf->x1l, x1r = lpf->x1r;
|
|
int32_t lfeedbacki = info->lfeedbacki, rfeedbacki = info->rfeedbacki, leveli = info->leveli,
|
|
dryi = info->dryi, weti = info->weti, ai = lpf->ai, iai = lpf->iai;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
info->size[0] = info->ldelay2 * playback_rate / 1000.0;
|
|
x = info->ldelay1 * playback_rate / 1000.0;
|
|
if (info->size[0] > x) {info->size[0] = x;}
|
|
x++;
|
|
set_delay(&(info->delayL), x);
|
|
info->index[0] = x - info->size[0];
|
|
info->size[1] = info->rdelay2 * playback_rate / 1000.0;
|
|
x = info->rdelay1 * playback_rate / 1000.0;
|
|
if (info->size[1] > x) {info->size[1] = x;}
|
|
x++;
|
|
set_delay(&(info->delayR), x);
|
|
info->index[1] = x - info->size[1];
|
|
info->lfeedbacki = TIM_FSCALE(info->lfeedback, 24);
|
|
info->rfeedbacki = TIM_FSCALE(info->rfeedback, 24);
|
|
info->leveli = TIM_FSCALE(info->level, 24);
|
|
info->dryi = TIM_FSCALE(info->dry, 24);
|
|
info->weti = TIM_FSCALE(info->wet, 24);
|
|
lpf->a = (1.0 - info->high_damp) * 44100.0 / playback_rate;
|
|
init_filter_lowpass1(lpf);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_delay(&(info->delayL));
|
|
free_delay(&(info->delayR));
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
y = bufL[indexl] + imuldiv24(bufL[index0], leveli);
|
|
x = imuldiv24(bufL[indexl], lfeedbacki);
|
|
do_filter_lowpass1(&x, &x1l, ai, iai);
|
|
bufL[indexl] = buf[i] + x;
|
|
buf[i] = imuldiv24(buf[i], dryi) + imuldiv24(y, weti);
|
|
|
|
y = bufR[indexr] + imuldiv24(bufR[index1], leveli);
|
|
x = imuldiv24(bufR[indexr], rfeedbacki);
|
|
do_filter_lowpass1(&x, &x1r, ai, iai);
|
|
bufR[indexr] = buf[++i] + x;
|
|
buf[i] = imuldiv24(buf[i], dryi) + imuldiv24(y, weti);
|
|
|
|
if (++index0 == sizel) {index0 = 0;}
|
|
if (++index1 == sizer) {index1 = 0;}
|
|
if (++indexl == sizel) {indexl = 0;}
|
|
if (++indexr == sizer) {indexr = 0;}
|
|
}
|
|
info->index[0] = index0, info->index[1] = index1;
|
|
lpf->x1l = x1l, lpf->x1r = x1r;
|
|
delayL->index = indexl, delayR->index = indexr;
|
|
}
|
|
|
|
void Reverb::conv_xg_cross_delay(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoCrossDelay *info = (InfoCrossDelay *)ef->info;
|
|
|
|
info->lrdelay = (double)clip_int(st->param_msb[0] * 128 + st->param_lsb[0], 1, 7430) / 10.0;
|
|
info->rldelay = (double)clip_int(st->param_msb[1] * 128 + st->param_lsb[1], 1, 7430) / 10.0;
|
|
info->feedback = (double)(st->param_lsb[2] - 64) * (0.763 * 2.0 / 100.0);
|
|
info->input_select = st->param_lsb[3];
|
|
info->high_damp = (double)clip_int(st->param_lsb[4], 1, 10) / 10.0;
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
}
|
|
|
|
void Reverb::do_cross_delay(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
int32_t i, lfb, rfb, lout, rout;
|
|
InfoCrossDelay *info = (InfoCrossDelay *)ef->info;
|
|
simple_delay *delayL = &(info->delayL), *delayR = &(info->delayR);
|
|
filter_lowpass1 *lpf = &(info->lpf);
|
|
int32_t *bufL = delayL->buf, *bufR = delayR->buf;
|
|
int32_t indexl = delayL->index, sizel = delayL->size,
|
|
indexr = delayR->index, sizer = delayR->size,
|
|
x1l = lpf->x1l, x1r = lpf->x1r;
|
|
int32_t feedbacki = info->feedbacki,
|
|
dryi = info->dryi, weti = info->weti, ai = lpf->ai, iai = lpf->iai;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
set_delay(&(info->delayL), (int32_t)(info->lrdelay * playback_rate / 1000.0));
|
|
set_delay(&(info->delayR), (int32_t)(info->rldelay * playback_rate / 1000.0));
|
|
info->feedbacki = TIM_FSCALE(info->feedback, 24);
|
|
info->dryi = TIM_FSCALE(info->dry, 24);
|
|
info->weti = TIM_FSCALE(info->wet, 24);
|
|
lpf->a = (1.0 - info->high_damp) * 44100.0 / playback_rate;
|
|
init_filter_lowpass1(lpf);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
free_delay(&(info->delayL));
|
|
free_delay(&(info->delayR));
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
lfb = imuldiv24(bufL[indexl], feedbacki);
|
|
do_filter_lowpass1(&lfb, &x1l, ai, iai);
|
|
lout = imuldiv24(buf[i], dryi) + imuldiv24(bufL[indexl], weti);
|
|
rfb = imuldiv24(bufR[indexr], feedbacki);
|
|
do_filter_lowpass1(&rfb, &x1r, ai, iai);
|
|
rout = imuldiv24(buf[i + 1], dryi) + imuldiv24(bufR[indexr], weti);
|
|
bufL[indexl] = buf[i] + rfb;
|
|
buf[i] = lout;
|
|
bufR[indexr] = buf[++i] + lfb;
|
|
buf[i] = rout;
|
|
|
|
if (++indexl == sizel) {indexl = 0;}
|
|
if (++indexr == sizer) {indexr = 0;}
|
|
}
|
|
lpf->x1l = x1l, lpf->x1r = x1r;
|
|
delayL->index = indexl, delayR->index = indexr;
|
|
}
|
|
|
|
void Reverb::conv_gs_lofi1(struct insertion_effect_gs_t *st, EffectList *ef)
|
|
{
|
|
InfoLoFi1 *info = (InfoLoFi1 *)ef->info;
|
|
|
|
info->pre_filter = st->parameter[0];
|
|
info->lofi_type = 1 + clip_int(st->parameter[1], 0, 8);
|
|
info->post_filter = st->parameter[2];
|
|
info->dry = calc_dry_gs(st->parameter[15] & 0x7F);
|
|
info->wet = calc_wet_gs(st->parameter[15] & 0x7F);
|
|
info->pan = st->parameter[18];
|
|
info->level = (st->parameter[19] & 0x7F) / 127.0;
|
|
}
|
|
|
|
int32_t Reverb::apply_lofi(int32_t input, int32_t bit_mask, int32_t level_shift)
|
|
{
|
|
return (input + level_shift) & bit_mask;
|
|
}
|
|
|
|
void Reverb::do_lofi1(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
int32_t i, x, y;
|
|
InfoLoFi1 *info = (InfoLoFi1 *)ef->info;
|
|
int32_t bit_mask = info->bit_mask, dryi = info->dryi, weti = info->weti;
|
|
const int32_t level_shift = info->level_shift;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
info->bit_mask = ~0L << (info->lofi_type * 2);
|
|
info->level_shift = ~info->bit_mask >> 1;
|
|
info->dryi = TIM_FSCALE(info->dry * info->level, 24);
|
|
info->weti = TIM_FSCALE(info->wet * info->level, 24);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
x = buf[i];
|
|
y = apply_lofi(x, bit_mask, level_shift);
|
|
buf[i] = imuldiv24(x, dryi) + imuldiv24(y, weti);
|
|
|
|
x = buf[++i];
|
|
y = apply_lofi(x, bit_mask, level_shift);
|
|
buf[i] = imuldiv24(x, dryi) + imuldiv24(y, weti);
|
|
}
|
|
}
|
|
|
|
void Reverb::conv_gs_lofi2(struct insertion_effect_gs_t *st, EffectList *ef)
|
|
{
|
|
InfoLoFi2 *info = (InfoLoFi2 *)ef->info;
|
|
|
|
info->lofi_type = 1 + clip_int(st->parameter[0], 0, 5);
|
|
info->fil_type = clip_int(st->parameter[1], 0, 2);
|
|
info->fil.freq = cutoff_freq_table_gs[st->parameter[2]];
|
|
info->rdetune = st->parameter[3];
|
|
info->rnz_lev = (double)st->parameter[4] / 127.0;
|
|
info->wp_sel = clip_int(st->parameter[5], 0, 1);
|
|
info->wp_lpf.freq = lpf_table_gs[st->parameter[6]];
|
|
info->wp_level = (double)st->parameter[7] / 127.0;
|
|
info->disc_type = clip_int(st->parameter[8], 0, 3);
|
|
info->disc_lpf.freq = lpf_table_gs[st->parameter[9]];
|
|
info->discnz_lev = (double)st->parameter[10] / 127.0;
|
|
info->hum_type = clip_int(st->parameter[11], 0, 1);
|
|
info->hum_lpf.freq = lpf_table_gs[st->parameter[12]];
|
|
info->hum_level = (double)st->parameter[13] / 127.0;
|
|
info->ms = clip_int(st->parameter[14], 0, 1);
|
|
info->dry = calc_dry_gs(st->parameter[15] & 0x7F);
|
|
info->wet = calc_wet_gs(st->parameter[15] & 0x7F);
|
|
info->pan = st->parameter[18];
|
|
info->level = (st->parameter[19] & 0x7F) / 127.0;
|
|
}
|
|
|
|
void Reverb::do_lofi2(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
int32_t i, x, y;
|
|
InfoLoFi2 *info = (InfoLoFi2 *)ef->info;
|
|
filter_biquad *fil = &(info->fil);
|
|
int32_t bit_mask = info->bit_mask, dryi = info->dryi, weti = info->weti;
|
|
const int32_t level_shift = info->level_shift;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
fil->q = 1.0;
|
|
if (info->fil_type == 1) {calc_filter_biquad_low(fil);}
|
|
else if (info->fil_type == 2) {calc_filter_biquad_high(fil);}
|
|
else {
|
|
fil->freq = -1; /* bypass */
|
|
calc_filter_biquad_low(fil);
|
|
}
|
|
info->bit_mask = ~0L << (info->lofi_type * 2);
|
|
info->level_shift = ~info->bit_mask >> 1;
|
|
info->dryi = TIM_FSCALE(info->dry * info->level, 24);
|
|
info->weti = TIM_FSCALE(info->wet * info->level, 24);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
x = buf[i];
|
|
y = apply_lofi(x, bit_mask, level_shift);
|
|
do_filter_biquad(&y, fil->a1, fil->a2, fil->b1, fil->b02, &fil->x1l, &fil->x2l, &fil->y1l, &fil->y2l);
|
|
buf[i] = imuldiv24(x, dryi) + imuldiv24(y, weti);
|
|
|
|
x = buf[++i];
|
|
y = apply_lofi(x, bit_mask, level_shift);
|
|
do_filter_biquad(&y, fil->a1, fil->a2, fil->b1, fil->b02, &fil->x1r, &fil->x2r, &fil->y1r, &fil->y2r);
|
|
buf[i] = imuldiv24(x, dryi) + imuldiv24(y, weti);
|
|
}
|
|
}
|
|
|
|
void Reverb::conv_xg_lofi(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoLoFi *info = (InfoLoFi *)ef->info;
|
|
|
|
info->srf.freq = lofi_sampling_freq_table_xg[st->param_lsb[0]] / 2.0;
|
|
info->word_length = st->param_lsb[1];
|
|
info->output_gain = clip_int(st->param_lsb[2], 0, 18);
|
|
info->lpf.freq = eq_freq_table_xg[clip_int(st->param_lsb[3], 10, 80)];
|
|
info->filter_type = st->param_lsb[4];
|
|
info->lpf.q = (double)clip_int(st->param_lsb[5], 10, 120) / 10.0;
|
|
info->bit_assign = clip_int(st->param_lsb[6], 0, 6);
|
|
info->emphasis = st->param_lsb[7];
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
}
|
|
|
|
void Reverb::do_lofi(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
int32_t i, x, y;
|
|
InfoLoFi *info = (InfoLoFi *)ef->info;
|
|
filter_biquad *lpf = &(info->lpf), *srf = &(info->srf);
|
|
int32_t bit_mask = info->bit_mask, dryi = info->dryi, weti = info->weti;
|
|
const int32_t level_shift = info->level_shift;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
srf->q = 1.0;
|
|
calc_filter_biquad_low(srf);
|
|
calc_filter_biquad_low(lpf);
|
|
info->bit_mask = ~((1L << (info->bit_assign + 22 - GUARD_BITS)) - 1L);
|
|
info->level_shift = ~info->bit_mask >> 1;
|
|
info->dryi = TIM_FSCALE(info->dry * pow(10.0, (double)info->output_gain / 20.0), 24);
|
|
info->weti = TIM_FSCALE(info->wet * pow(10.0, (double)info->output_gain / 20.0), 24);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
x = buf[i];
|
|
y = apply_lofi(x, bit_mask, level_shift);
|
|
do_filter_biquad(&y, srf->a1, srf->a2, srf->b1, srf->b02, &srf->x1l, &srf->x2l, &srf->y1l, &srf->y2l);
|
|
do_filter_biquad(&y, lpf->a1, lpf->a2, lpf->b1, lpf->b02, &lpf->x1l, &lpf->x2l, &lpf->y1l, &lpf->y2l);
|
|
buf[i] = imuldiv24(x, dryi) + imuldiv24(y, weti);
|
|
|
|
x = buf[++i];
|
|
y = apply_lofi(x, bit_mask, level_shift);
|
|
do_filter_biquad(&y, srf->a1, srf->a2, srf->b1, srf->b02, &srf->x1r, &srf->x2r, &srf->y1r, &srf->y2r);
|
|
do_filter_biquad(&y, lpf->a1, lpf->a2, lpf->b1, lpf->b02, &lpf->x1r, &lpf->x2r, &lpf->y1r, &lpf->y2r);
|
|
buf[i] = imuldiv24(x, dryi) + imuldiv24(y, weti);
|
|
}
|
|
}
|
|
|
|
void Reverb::conv_xg_auto_wah_od(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoXGAutoWahOD *info = (InfoXGAutoWahOD *)ef->info;
|
|
|
|
info->lpf.freq = eq_freq_table_xg[clip_int(st->param_lsb[13], 34, 80)];
|
|
info->level = (double)st->param_lsb[14] / 127.0;
|
|
}
|
|
|
|
void Reverb::conv_xg_auto_wah_od_eq3(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoEQ3 *info = (InfoEQ3 *)ef->info;
|
|
|
|
info->low_freq = eq_freq_table_xg[24];
|
|
info->low_gain = clip_int(st->param_lsb[11] - 64, -12, 12);
|
|
info->mid_freq = eq_freq_table_xg[41];
|
|
info->mid_gain = clip_int(st->param_lsb[12] - 64, -12, 12);
|
|
info->mid_width = 1.0;
|
|
info->high_freq = 0;
|
|
info->high_gain = 0;
|
|
}
|
|
|
|
void Reverb::conv_xg_auto_wah_eq2(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoEQ2 *info = (InfoEQ2 *)ef->info;
|
|
|
|
info->low_freq = eq_freq_table_xg[clip_int(st->param_lsb[5], 4, 40)];
|
|
info->low_gain = clip_int(st->param_lsb[6] - 64, -12, 12);
|
|
info->high_freq = eq_freq_table_xg[clip_int(st->param_lsb[7], 28, 58)];
|
|
info->high_gain = clip_int(st->param_lsb[8] - 64, -12, 12);
|
|
}
|
|
|
|
void Reverb::conv_xg_auto_wah(struct effect_xg_t *st, EffectList *ef)
|
|
{
|
|
InfoXGAutoWah *info = (InfoXGAutoWah *)ef->info;
|
|
|
|
info->lfo_freq = lfo_freq_table_xg[st->param_lsb[0]];
|
|
info->lfo_depth = st->param_lsb[1];
|
|
info->offset_freq = (double)(st->param_lsb[2]) * 3900.0 / 127.0 + 100.0;
|
|
info->resonance = (double)clip_int(st->param_lsb[3], 10, 120) / 10.0;
|
|
info->dry = calc_dry_xg(st->param_lsb[9], st);
|
|
info->wet = calc_wet_xg(st->param_lsb[9], st);
|
|
info->drive = st->param_lsb[10];
|
|
}
|
|
|
|
double Reverb::calc_xg_auto_wah_freq(int32_t lfo_val, double offset_freq, int8_t depth)
|
|
{
|
|
double freq;
|
|
int32_t fine;
|
|
fine = ((lfo_val - (1L << 15)) * depth) >> 7; /* max: +-2^8 fine */
|
|
if (fine >= 0) {
|
|
freq = offset_freq * bend_fine[fine & 0xff]
|
|
* bend_coarse[fine >> 8 & 0x7f];
|
|
} else {
|
|
freq = offset_freq / (bend_fine[(-fine) & 0xff]
|
|
* bend_coarse[(-fine) >> 8 & 0x7f]);
|
|
}
|
|
return freq;
|
|
}
|
|
|
|
#define XG_AUTO_WAH_BITS (32 - GUARD_BITS)
|
|
#define XG_AUTO_WAH_MAX_NEG (1.0 / (double)(1L << XG_AUTO_WAH_BITS))
|
|
|
|
void Reverb::do_xg_auto_wah(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
int32_t i, x, y, val;
|
|
InfoXGAutoWah *info = (InfoXGAutoWah *)ef->info;
|
|
filter_moog_dist *fil0 = &(info->fil0), *fil1 = &(info->fil1);
|
|
lfo *lfo = &(info->lfo);
|
|
int32_t dryi = info->dryi, weti = info->weti, fil_cycle = info->fil_cycle;
|
|
int8_t lfo_depth = info->lfo_depth;
|
|
double yf, offset_freq = info->offset_freq;
|
|
int32_t fil_count = info->fil_count;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
init_lfo(lfo, info->lfo_freq, LFO_TRIANGULAR, 0);
|
|
fil0->res_dB = fil1->res_dB = (info->resonance - 1.0) * 12.0 / 11.0;
|
|
fil0->dist = fil1->dist = 4.0 * sqrt((double)info->drive / 127.0);
|
|
val = do_lfo(lfo);
|
|
fil0->freq = fil1->freq = calc_xg_auto_wah_freq(val, info->offset_freq, info->lfo_depth);
|
|
calc_filter_moog_dist(fil0);
|
|
init_filter_moog_dist(fil0);
|
|
calc_filter_moog_dist(fil1);
|
|
init_filter_moog_dist(fil1);
|
|
info->fil_count = 0;
|
|
info->fil_cycle = (int32_t)(44.0 * playback_rate / 44100.0);
|
|
info->dryi = TIM_FSCALE(info->dry, 24);
|
|
info->weti = TIM_FSCALE(info->wet, 24);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
x = y = buf[i];
|
|
yf = (double)y * XG_AUTO_WAH_MAX_NEG;
|
|
do_filter_moog_dist_band(&yf, fil0->f, fil0->p, fil0->q, fil0->d,
|
|
&fil0->b0, &fil0->b1, &fil0->b2, &fil0->b3, &fil0->b4);
|
|
y = TIM_FSCALE(yf, XG_AUTO_WAH_BITS);
|
|
buf[i] = imuldiv24(x, dryi) + imuldiv24(y, weti);
|
|
|
|
x = y = buf[++i];
|
|
yf = (double)y * XG_AUTO_WAH_MAX_NEG;
|
|
do_filter_moog_dist_band(&yf, fil0->f, fil0->p, fil0->q, fil0->d,
|
|
&fil1->b0, &fil1->b1, &fil1->b2, &fil1->b3, &fil1->b4);
|
|
y = TIM_FSCALE(yf, XG_AUTO_WAH_BITS);
|
|
buf[i] = imuldiv24(x, dryi) + imuldiv24(y, weti);
|
|
|
|
val = do_lfo(lfo);
|
|
|
|
if (++fil_count == fil_cycle) {
|
|
fil_count = 0;
|
|
fil0->freq = calc_xg_auto_wah_freq(val, offset_freq, lfo_depth);
|
|
calc_filter_moog_dist(fil0);
|
|
}
|
|
}
|
|
info->fil_count = fil_count;
|
|
}
|
|
|
|
void Reverb::do_xg_auto_wah_od(int32_t *buf, int32_t count, EffectList *ef)
|
|
{
|
|
int32_t i, x;
|
|
InfoXGAutoWahOD *info = (InfoXGAutoWahOD *)ef->info;
|
|
filter_biquad *lpf = &(info->lpf);
|
|
int32_t leveli = info->leveli;
|
|
|
|
if(count == MAGIC_INIT_EFFECT_INFO) {
|
|
lpf->q = 1.0;
|
|
calc_filter_biquad_low(lpf);
|
|
info->leveli = TIM_FSCALE(info->level, 24);
|
|
return;
|
|
} else if(count == MAGIC_FREE_EFFECT_INFO) {
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
x = buf[i];
|
|
do_filter_biquad(&x, lpf->a1, lpf->a2, lpf->b1, lpf->b02, &lpf->x1l, &lpf->x2l, &lpf->y1l, &lpf->y2l);
|
|
buf[i] = imuldiv24(x, leveli);
|
|
|
|
x = buf[++i];
|
|
do_filter_biquad(&x, lpf->a1, lpf->a2, lpf->b1, lpf->b02, &lpf->x1r, &lpf->x2r, &lpf->y1r, &lpf->y2r);
|
|
buf[i] = imuldiv24(x, leveli);
|
|
}
|
|
}
|
|
|
|
enum { /* width * length * height */
|
|
ER_SMALL_ROOM, /* 5m * 5m * 3m */
|
|
ER_MEDIUM_ROOM, /* 10m * 10m * 5m */
|
|
ER_LARGE_ROOM, /* 12m * 12m * 8m */
|
|
ER_MEDIUM_HALL, /* 15m * 20m * 10m */
|
|
ER_LARGE_HALL, /* 20m * 40m * 18m */
|
|
ER_EOF,
|
|
};
|
|
|
|
|
|
const struct _EffectEngine Reverb::effect_engine[] = {
|
|
{ EFFECT_NONE, "None", NULL, NULL, NULL, 0,},
|
|
{ EFFECT_STEREO_EQ, "Stereo-EQ", &Reverb::do_stereo_eq, &Reverb::conv_gs_stereo_eq, NULL, sizeof(InfoStereoEQ),},
|
|
{ EFFECT_EQ2, "2-Band EQ", &Reverb::do_eq2, &Reverb::conv_gs_eq2, &Reverb::conv_xg_eq2, sizeof(InfoEQ2),},
|
|
{ EFFECT_EQ3, "3-Band EQ", &Reverb::do_eq3, NULL, &Reverb::conv_xg_eq3, sizeof(InfoEQ3),},
|
|
{ EFFECT_OVERDRIVE1, "Overdrive", &Reverb::do_overdrive1, &Reverb::conv_gs_overdrive1, NULL, sizeof(InfoOverdrive1),},
|
|
{ EFFECT_DISTORTION1, "Distortion", &Reverb::do_distortion1, &Reverb::conv_gs_overdrive1, NULL, sizeof(InfoOverdrive1),},
|
|
{ EFFECT_OD1OD2, "OD1/OD2", &Reverb::do_dual_od, &Reverb::conv_gs_dual_od, NULL, sizeof(InfoOD1OD2),},
|
|
{ EFFECT_HEXA_CHORUS, "Hexa-Chorus", &Reverb::do_hexa_chorus, &Reverb::conv_gs_hexa_chorus, NULL, sizeof(InfoHexaChorus),},
|
|
{ EFFECT_CHORUS, "Chorus", &Reverb::do_chorus, NULL, &Reverb::conv_xg_chorus, sizeof(InfoChorus),},
|
|
{ EFFECT_FLANGER, "Flanger", &Reverb::do_chorus, NULL, &Reverb::conv_xg_flanger, sizeof(InfoChorus),},
|
|
{ EFFECT_SYMPHONIC, "Symphonic", &Reverb::do_chorus, NULL, &Reverb::conv_xg_symphonic, sizeof(InfoChorus),},
|
|
{ EFFECT_CHORUS_EQ3, "3-Band EQ (XG Chorus built-in)", &Reverb::do_eq3, NULL, &Reverb::conv_xg_chorus_eq3, sizeof(InfoEQ3),},
|
|
{ EFFECT_STEREO_OVERDRIVE, "Stereo Overdrive", &Reverb::do_stereo_od, NULL, &Reverb::conv_xg_overdrive, sizeof(InfoStereoOD),},
|
|
{ EFFECT_STEREO_DISTORTION, "Stereo Distortion", &Reverb::do_stereo_od, NULL, &Reverb::conv_xg_distortion, sizeof(InfoStereoOD),},
|
|
{ EFFECT_STEREO_AMP_SIMULATOR, "Amp Simulator", &Reverb::do_stereo_od, NULL, &Reverb::conv_xg_amp_simulator, sizeof(InfoStereoOD),},
|
|
{ EFFECT_OD_EQ3, "2-Band EQ (XG OD built-in)", &Reverb::do_eq3, NULL, &Reverb::conv_xg_od_eq3, sizeof(InfoEQ3),},
|
|
{ EFFECT_DELAY_LCR, "Delay L,C,R", &Reverb::do_delay_lcr, NULL, &Reverb::conv_xg_delay_lcr, sizeof(InfoDelayLCR),},
|
|
{ EFFECT_DELAY_LR, "Delay L,R", &Reverb::do_delay_lr, NULL, &Reverb::conv_xg_delay_lr, sizeof(InfoDelayLR),},
|
|
{ EFFECT_ECHO, "Echo", &Reverb::do_echo, NULL, &Reverb::conv_xg_echo, sizeof(InfoEcho),},
|
|
{ EFFECT_CROSS_DELAY, "Cross Delay", &Reverb::do_cross_delay, NULL, &Reverb::conv_xg_cross_delay, sizeof(InfoCrossDelay),},
|
|
{ EFFECT_DELAY_EQ2, "2-Band EQ (XG Delay built-in)", &Reverb::do_eq2, NULL, &Reverb::conv_xg_delay_eq2, sizeof(InfoEQ2),},
|
|
{ EFFECT_LOFI, "Lo-Fi", &Reverb::do_lofi, NULL, &Reverb::conv_xg_lofi, sizeof(InfoLoFi),},
|
|
{ EFFECT_LOFI1, "Lo-Fi 1", &Reverb::do_lofi1, &Reverb::conv_gs_lofi1, NULL, sizeof(InfoLoFi1),},
|
|
{ EFFECT_LOFI2, "Lo-Fi 2", &Reverb::do_lofi2, &Reverb::conv_gs_lofi2, NULL, sizeof(InfoLoFi2),},
|
|
{ EFFECT_XG_AUTO_WAH, "Auto Wah", &Reverb::do_xg_auto_wah, NULL, &Reverb::conv_xg_auto_wah, sizeof(InfoXGAutoWah),},
|
|
{ EFFECT_XG_AUTO_WAH_EQ2, "2-Band EQ (Auto Wah built-in)", &Reverb::do_eq2, NULL, &Reverb::conv_xg_auto_wah_eq2, sizeof(InfoEQ2),},
|
|
{ EFFECT_XG_AUTO_WAH_OD, "OD (Auto Wah built-in)", &Reverb::do_xg_auto_wah_od, NULL, &Reverb::conv_xg_auto_wah_od, sizeof(InfoXGAutoWahOD),},
|
|
{ EFFECT_XG_AUTO_WAH_OD_EQ3, "2-Band EQ (Auto Wah OD built-in)", &Reverb::do_eq3, NULL, &Reverb::conv_xg_auto_wah_od_eq3, sizeof(InfoEQ3),},
|
|
{ -1, "EOF", NULL, NULL, NULL, 0, },
|
|
};
|
|
|
|
const struct effect_parameter_xg_t Reverb::effect_parameter_xg[] = {
|
|
{ 0, 0, "NO EFFECT",
|
|
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},
|
|
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,}, 0, },
|
|
|
|
{ 0x05, 0, "DELAY L,C,R", { 0x1A, 0x0D, 0x27, 0x27, 0, 0, 0, 0, 0, 0,},{
|
|
0x05, 0x03, 0x08, 0x08, 74, 100, 10, 0, 0, 32, 0, 0, 28, 64, 46, 64,}, 9,},
|
|
|
|
{ 0x06, 0, "DELAY L,R", { 0x13, 0x1D, 0x1D, 0x1D, 0, 0, 0, 0, 0, 0,},{
|
|
0x44, 0x26, 0x28, 0x26, 87, 10, 0, 0, 0, 32, 0, 0, 28, 64, 46, 64, },9,},
|
|
|
|
{ 0x07, 0, "ECHO", { 0x0D, 0, 0x0D, 0, 0, 0x0D, 0x0D, 0, 0, 0,},{
|
|
0x24, 80, 0x74, 80, 10, 0x24, 0x74, 0, 0, 40, 0, 0, 28, 64, 46, 64,}, 9,},
|
|
|
|
{ 0x08, 0, "CROSS DELAY", { 0x0D, 0x0D, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
0x24, 0x56, 111, 1, 10, 0, 0, 0, 0, 32, 0, 0, 28, 64, 46, 64,}, 9,},
|
|
|
|
{ 0x41, 0, "CHORUS 1", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
6, 54, 77, 106, 0, 28, 64, 46, 64, 64, 46, 64, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x41, 0x01, "CHORUS 2",{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
8, 63, 64, 30, 0, 28, 62, 42, 58, 64, 46, 64, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x41, 0x02, "CHORUS 3",{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
4, 44, 64, 110, 0, 28, 64, 46, 66, 64, 46, 64, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x41, 0x03, "GM CHORUS 1",{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
9, 10, 64, 109, 0, 28, 64, 46, 64, 64, 46, 64, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x41, 0x04, "GM CHORUS 2", {0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
28, 34, 67, 105, 0, 28, 64, 46, 64, 64, 46, 64, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x41, 0x05, "GM CHORUS 3", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
9, 34, 69, 105, 0, 28, 64, 46, 64, 64, 46, 64, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x41, 0x06, "GM CHORUS 4", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
26, 29, 75, 102, 0, 28, 64, 46, 64, 64, 46, 64, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x41, 0x07, "FB CHORUS", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
6, 43, 107, 111, 0, 28, 64, 46, 64, 64, 46, 64, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x41, 0x08, "CHORUS 4", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
9, 32, 69, 104, 0, 28, 64, 46, 64, 64, 46, 64, 10, 0, 1, 0,}, 9,},
|
|
|
|
{ 0x42, 0, "CELESTE 1", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
12, 32, 64, 0, 0, 28, 64, 46, 64, 127, 40, 68, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x42, 0x01, "CELESTE 2", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
28, 18, 90, 2, 0, 28, 62, 42, 60, 84, 40, 68, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x42, 0x02, "CELESTE 3", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
4, 63, 44, 2, 0, 28, 64, 46, 68, 127, 40, 68, 10, 0, 0,0,}, 9,},
|
|
|
|
{ 0x42, 0x08, "CELESTE 4", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
8, 29, 64, 0, 0, 28, 64, 51, 66, 127, 40, 68, 10, 0, 1, 0,}, 9,},
|
|
|
|
{ 0x43, 0, "FLANGER 1", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
14, 14, 104, 2, 0, 28, 64, 46, 64, 96, 40, 64, 10, 4, 0, 0,}, 9, },
|
|
|
|
{ 0x43, 0x01, "FLANGER 2", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
32, 17, 26, 2, 0, 28, 64, 46, 60, 96, 40, 64, 10, 4, 0, 0,}, 9, },
|
|
|
|
{ 0x43, 0x07, "GM FLANGER", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
3, 21, 120, 1, 0, 28, 64, 46, 64, 96, 40, 64, 10, 4, 0, 0,}, 9, },
|
|
|
|
{ 0x43, 0x08, "FLANGER 3", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
4, 109, 109, 2, 0, 28, 64, 46, 64, 127, 40, 64, 10, 4, 0, 0,}, 9, },
|
|
|
|
{ 0x44, 0, "SYMPHONIC", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
12, 25, 16, 0, 0, 28, 64, 46, 64, 127, 46, 64, 10, 0, 0, 0,}, 9,},
|
|
|
|
{ 0x49, 0, "DISTORTION", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
40, 20, 72, 53, 48, 0, 43, 74, 10, 127, 120, 0, 0, 0, 0,0,}, 0,},
|
|
|
|
{ 0x49, 0x08, "STEREO DISTORTION", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
18, 27, 71, 48, 84, 0, 32, 66, 10, 127, 105, 0, 0, 0, 0, 0,}, 0,},
|
|
|
|
{ 0x4A, 0, "OVERDRIVE", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
29, 24, 68, 45, 55, 0, 41, 72, 10, 127, 104, 0, 0, 0, 0, 0,}, 0,},
|
|
|
|
{ 0x4A, 0x08, "STEREO OVERDRIVE", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
10, 24, 69, 46, 105, 0, 41, 66, 10, 127, 104, 0, 0, 0, 0, 0,}, 0,},
|
|
|
|
{ 0x4B, 0, "AMP SIMULATOR", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
39, 1, 48, 55, 0, 0, 0, 0, 0, 127, 112, 0, 0, 0, 0, 0,}, 0,},
|
|
|
|
{ 0x4B, 0x08, "STEREO AMP SIMULATOR", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
16, 2, 46, 119, 0, 0, 0, 0, 0, 127, 106, 0, 0, 0, 0, 0,}, 0,},
|
|
|
|
{ 0x4C, 0, "3-BAND EQ", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
70, 34, 60, 10, 70, 28, 46, 0, 0, 127, 0, 0, 0, 0, 0, 0,}, -1,},
|
|
|
|
{ 0x4D, 0, "2-BAND EQ", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
28, 70, 46, 70, 0, 0, 0, 0, 0, 127, 0, 0, 0, 0, 0, 0,}, -1,},
|
|
|
|
{ 0x4E, 0, "AUTO WAH", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
70, 56, 39, 25, 0, 28, 66, 46, 64, 127, 0, 0, 0, 0, 0, 0,}, 2, },
|
|
|
|
{ 0x4E, 0x01, "AUTO WAH+DISTORTION", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
40, 73, 26, 29, 0, 28, 66, 46, 64, 127, 30, 72, 74, 53, 48, 0,}, 2, },
|
|
|
|
{ 0x4E, 0x02, "AUTO WAH+OVERDRIVE", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
48, 64, 32, 23, 0, 28, 66, 46, 64, 127, 29, 68, 72, 45, 55, 0,}, 2, },
|
|
|
|
{ 0x5E, 0, "LO-FI",{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
2, 60, 6, 54, 5, 10, 1, 1, 0, 127, 0, 0, 0, 0, 1, 0,}, 9, },
|
|
|
|
{ -1, -1, "EOF",{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,},{
|
|
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,}, 0,},
|
|
};
|
|
|
|
const struct effect_parameter_gs_t Reverb::effect_parameter_gs[] = {
|
|
{ 0, 0, "None", { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0, 0, 0, 0, 0,}, 0, 0,},
|
|
{ 0x01, 0x00, "Stereo-EQ", { 1, 0x45, 1, 0x34, 0x48, 0, 0x48, 0x38, 0, 0x48,
|
|
0, 0, 0, 0, 0, 0, 0, 0, 0, 127,}, 19, -1,},
|
|
{ 0x01, 0x10, "Overdrive",{ 48, 1, 1, 0, 0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0, 0x40, 0x40, 0x40, 96,}, 0, 18,},
|
|
{ 0x01, 0x11, "Distrotion",{ 76, 3, 1, 0, 0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0, 0x40, 0x38, 0x40, 84,}, 0, 18, },
|
|
{ 0x11, 0x03, "OD1/OD2",{ 0, 48, 1, 1, 0, 1, 76, 3, 1, 0,
|
|
0, 0, 0, 0, 0, 0x40, 96, 0x40, 84, 127,}, 1, 6, },
|
|
{ 0x01, 0x40, "Hexa Chorus",{ 0x18, 0x08, 127, 5, 66, 16, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0, 0x40, 0x40, 64, 112,}, 1, 15, },
|
|
{ 0x01, 0x72, "Lo-Fi 1",{ 2, 6, 2, 0, 0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 127, 0x40, 0x40, 64, 127,}, 15, 18, },
|
|
{ 0x01, 0x73, "Lo-Fi 2",{ 2, 1, 0x20, 0, 64, 1, 127, 0, 0, 127,
|
|
0, 0, 127, 0, 1, 127, 0x40, 0x40, 64, 127,}, 3, 15, },
|
|
{ -1, -1, "EOF",{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0, 0, 0, 0, 0,}, 0, 0,},
|
|
};
|
|
|
|
|
|
////////////////////////////////// from readmidi
|
|
|
|
/*! initialize Delay Effect (GS) */
|
|
void Reverb::init_delay_status_gs(void)
|
|
{
|
|
struct delay_status_gs_t *p = &delay_status_gs;
|
|
p->type = 0;
|
|
p->level = 0x40;
|
|
p->level_center = 0x7F;
|
|
p->level_left = 0;
|
|
p->level_right = 0;
|
|
p->time_c = 0x61;
|
|
p->time_l = 0x01;
|
|
p->time_r = 0x01;
|
|
p->feedback = 0x50;
|
|
p->pre_lpf = 0;
|
|
recompute_delay_status_gs();
|
|
}
|
|
|
|
/*! recompute Delay Effect (GS) */
|
|
void Reverb::recompute_delay_status_gs(void)
|
|
{
|
|
struct delay_status_gs_t *p = &delay_status_gs;
|
|
p->time_center = delay_time_center_table[p->time_c > 0x73 ? 0x73 : p->time_c];
|
|
p->time_ratio_left = (double)p->time_l / 24;
|
|
p->time_ratio_right = (double)p->time_r / 24;
|
|
p->sample[0] = p->time_center * playback_rate / 1000.0f;
|
|
p->sample[1] = p->sample[0] * p->time_ratio_left;
|
|
p->sample[2] = p->sample[0] * p->time_ratio_right;
|
|
p->level_ratio[0] = p->level * p->level_center / (127.0f * 127.0f);
|
|
p->level_ratio[1] = p->level * p->level_left / (127.0f * 127.0f);
|
|
p->level_ratio[2] = p->level * p->level_right / (127.0f * 127.0f);
|
|
p->feedback_ratio = (double)(p->feedback - 64) * (0.763f * 2.0f / 100.0f);
|
|
p->send_reverb_ratio = (double)p->send_reverb * (0.787f / 100.0f);
|
|
|
|
if (p->level_left != 0 || (p->level_right != 0 && p->type == 0)) {
|
|
p->type = 1; /* it needs 3-tap delay effect. */
|
|
}
|
|
|
|
if (p->pre_lpf) {
|
|
p->lpf.a = 2.0 * ((double)(7 - p->pre_lpf) / 7.0f * 16000.0f + 200.0f) / playback_rate;
|
|
init_filter_lowpass1(&(p->lpf));
|
|
}
|
|
}
|
|
|
|
/*! Delay Macro (GS) */
|
|
void Reverb::set_delay_macro_gs(int macro)
|
|
{
|
|
struct delay_status_gs_t *p = &delay_status_gs;
|
|
if (macro >= 4) { p->type = 2; } /* cross delay */
|
|
macro *= 10;
|
|
p->time_center = delay_time_center_table[delay_macro_presets[macro + 1]];
|
|
p->time_ratio_left = (double)delay_macro_presets[macro + 2] / 24;
|
|
p->time_ratio_right = (double)delay_macro_presets[macro + 3] / 24;
|
|
p->level_center = delay_macro_presets[macro + 4];
|
|
p->level_left = delay_macro_presets[macro + 5];
|
|
p->level_right = delay_macro_presets[macro + 6];
|
|
p->level = delay_macro_presets[macro + 7];
|
|
p->feedback = delay_macro_presets[macro + 8];
|
|
}
|
|
|
|
/*! initialize Reverb Effect (GS) */
|
|
void Reverb::init_reverb_status_gs(void)
|
|
{
|
|
struct reverb_status_gs_t *p = &reverb_status_gs;
|
|
p->character = 0x04;
|
|
p->pre_lpf = 0;
|
|
p->level = 0x40;
|
|
p->time = 0x40;
|
|
p->delay_feedback = 0;
|
|
p->pre_delay_time = 0;
|
|
recompute_reverb_status_gs();
|
|
init_reverb();
|
|
}
|
|
|
|
/*! recompute Reverb Effect (GS) */
|
|
void Reverb::recompute_reverb_status_gs(void)
|
|
{
|
|
struct reverb_status_gs_t *p = &reverb_status_gs;
|
|
|
|
if (p->pre_lpf) {
|
|
p->lpf.a = 2.0 * ((double)(7 - p->pre_lpf) / 7.0f * 16000.0f + 200.0f) / playback_rate;
|
|
init_filter_lowpass1(&(p->lpf));
|
|
}
|
|
}
|
|
|
|
/*! Reverb Type (GM2) */
|
|
void Reverb::set_reverb_macro_gm2(int macro)
|
|
{
|
|
struct reverb_status_gs_t *p = &reverb_status_gs;
|
|
int type = macro;
|
|
if (macro == 8) { macro = 5; }
|
|
macro *= 6;
|
|
p->character = reverb_macro_presets[macro];
|
|
p->pre_lpf = reverb_macro_presets[macro + 1];
|
|
p->level = reverb_macro_presets[macro + 2];
|
|
p->time = reverb_macro_presets[macro + 3];
|
|
p->delay_feedback = reverb_macro_presets[macro + 4];
|
|
p->pre_delay_time = reverb_macro_presets[macro + 5];
|
|
|
|
switch (type) { /* override GS macro's parameter */
|
|
case 0: /* Small Room */
|
|
p->time = 44;
|
|
break;
|
|
case 1: /* Medium Room */
|
|
case 8: /* Plate */
|
|
p->time = 50;
|
|
break;
|
|
case 2: /* Large Room */
|
|
p->time = 56;
|
|
break;
|
|
case 3: /* Medium Hall */
|
|
case 4: /* Large Hall */
|
|
p->time = 64;
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*! Reverb Macro (GS) */
|
|
void Reverb::set_reverb_macro_gs(int macro)
|
|
{
|
|
struct reverb_status_gs_t *p = &reverb_status_gs;
|
|
macro *= 6;
|
|
p->character = reverb_macro_presets[macro];
|
|
p->pre_lpf = reverb_macro_presets[macro + 1];
|
|
p->level = reverb_macro_presets[macro + 2];
|
|
p->time = reverb_macro_presets[macro + 3];
|
|
p->delay_feedback = reverb_macro_presets[macro + 4];
|
|
p->pre_delay_time = reverb_macro_presets[macro + 5];
|
|
}
|
|
|
|
/*! initialize Chorus Effect (GS) */
|
|
void Reverb::init_chorus_status_gs(void)
|
|
{
|
|
struct chorus_status_gs_t *p = &chorus_status_gs;
|
|
p->macro = 0;
|
|
p->pre_lpf = 0;
|
|
p->level = 0x40;
|
|
p->feedback = 0x08;
|
|
p->delay = 0x50;
|
|
p->rate = 0x03;
|
|
p->depth = 0x13;
|
|
p->send_reverb = 0;
|
|
p->send_delay = 0;
|
|
recompute_chorus_status_gs();
|
|
}
|
|
|
|
/*! recompute Chorus Effect (GS) */
|
|
void Reverb::recompute_chorus_status_gs()
|
|
{
|
|
struct chorus_status_gs_t *p = &chorus_status_gs;
|
|
|
|
if (p->pre_lpf) {
|
|
p->lpf.a = 2.0 * ((double)(7 - p->pre_lpf) / 7.0f * 16000.0f + 200.0f) / playback_rate;
|
|
init_filter_lowpass1(&(p->lpf));
|
|
}
|
|
}
|
|
|
|
/*! Chorus Macro (GS), Chorus Type (GM2) */
|
|
void Reverb::set_chorus_macro_gs(int macro)
|
|
{
|
|
struct chorus_status_gs_t *p = &chorus_status_gs;
|
|
macro *= 8;
|
|
p->pre_lpf = chorus_macro_presets[macro];
|
|
p->level = chorus_macro_presets[macro + 1];
|
|
p->feedback = chorus_macro_presets[macro + 2];
|
|
p->delay = chorus_macro_presets[macro + 3];
|
|
p->rate = chorus_macro_presets[macro + 4];
|
|
p->depth = chorus_macro_presets[macro + 5];
|
|
p->send_reverb = chorus_macro_presets[macro + 6];
|
|
p->send_delay = chorus_macro_presets[macro + 7];
|
|
}
|
|
|
|
/*! initialize EQ (GS) */
|
|
void Reverb::init_eq_status_gs(void)
|
|
{
|
|
struct eq_status_gs_t *p = &eq_status_gs;
|
|
p->low_freq = 0;
|
|
p->low_gain = 0x40;
|
|
p->high_freq = 0;
|
|
p->high_gain = 0x40;
|
|
recompute_eq_status_gs();
|
|
}
|
|
|
|
/*! recompute EQ (GS) */
|
|
void Reverb::recompute_eq_status_gs(void)
|
|
{
|
|
double freq, dbGain;
|
|
struct eq_status_gs_t *p = &eq_status_gs;
|
|
|
|
/* Lowpass Shelving Filter */
|
|
if (p->low_freq == 0) { freq = 200; }
|
|
else { freq = 400; }
|
|
dbGain = p->low_gain - 0x40;
|
|
if (freq < playback_rate / 2) {
|
|
p->lsf.q = 0;
|
|
p->lsf.freq = freq;
|
|
p->lsf.gain = dbGain;
|
|
calc_filter_shelving_low(&(p->lsf));
|
|
}
|
|
|
|
/* Highpass Shelving Filter */
|
|
if (p->high_freq == 0) { freq = 3000; }
|
|
else { freq = 6000; }
|
|
dbGain = p->high_gain - 0x40;
|
|
if (freq < playback_rate / 2) {
|
|
p->hsf.q = 0;
|
|
p->hsf.freq = freq;
|
|
p->hsf.gain = dbGain;
|
|
calc_filter_shelving_high(&(p->hsf));
|
|
}
|
|
}
|
|
|
|
/*! initialize Multi EQ (XG) */
|
|
void Reverb::init_multi_eq_xg(void)
|
|
{
|
|
multi_eq_xg.valid = 0;
|
|
set_multi_eq_type_xg(0);
|
|
recompute_multi_eq_xg();
|
|
}
|
|
|
|
/*! set Multi EQ type (XG) */
|
|
void Reverb::set_multi_eq_type_xg(int type)
|
|
{
|
|
struct multi_eq_xg_t *p = &multi_eq_xg;
|
|
type *= 20;
|
|
p->gain1 = multi_eq_block_table_xg[type];
|
|
p->freq1 = multi_eq_block_table_xg[type + 1];
|
|
p->q1 = multi_eq_block_table_xg[type + 2];
|
|
p->shape1 = multi_eq_block_table_xg[type + 3];
|
|
p->gain2 = multi_eq_block_table_xg[type + 4];
|
|
p->freq2 = multi_eq_block_table_xg[type + 5];
|
|
p->q2 = multi_eq_block_table_xg[type + 6];
|
|
p->gain3 = multi_eq_block_table_xg[type + 8];
|
|
p->freq3 = multi_eq_block_table_xg[type + 9];
|
|
p->q3 = multi_eq_block_table_xg[type + 10];
|
|
p->gain4 = multi_eq_block_table_xg[type + 12];
|
|
p->freq4 = multi_eq_block_table_xg[type + 13];
|
|
p->q4 = multi_eq_block_table_xg[type + 14];
|
|
p->gain5 = multi_eq_block_table_xg[type + 16];
|
|
p->freq5 = multi_eq_block_table_xg[type + 17];
|
|
p->q5 = multi_eq_block_table_xg[type + 18];
|
|
p->shape5 = multi_eq_block_table_xg[type + 19];
|
|
}
|
|
|
|
/*! recompute Multi EQ (XG) */
|
|
void Reverb::recompute_multi_eq_xg(void)
|
|
{
|
|
struct multi_eq_xg_t *p = &multi_eq_xg;
|
|
|
|
if (p->freq1 != 0 && p->freq1 < 60 && p->gain1 != 0x40) {
|
|
p->valid1 = 1;
|
|
if (p->shape1) { /* peaking */
|
|
p->eq1p.q = (double)p->q1 / 10.0;
|
|
p->eq1p.freq = eq_freq_table_xg[p->freq1];
|
|
p->eq1p.gain = p->gain1 - 0x40;
|
|
calc_filter_peaking(&(p->eq1p));
|
|
}
|
|
else { /* shelving */
|
|
p->eq1s.q = (double)p->q1 / 10.0;
|
|
p->eq1s.freq = eq_freq_table_xg[p->freq1];
|
|
p->eq1s.gain = p->gain1 - 0x40;
|
|
calc_filter_shelving_low(&(p->eq1s));
|
|
}
|
|
}
|
|
else { p->valid1 = 0; }
|
|
if (p->freq2 != 0 && p->freq2 < 60 && p->gain2 != 0x40) {
|
|
p->valid2 = 1;
|
|
p->eq2p.q = (double)p->q2 / 10.0;
|
|
p->eq2p.freq = eq_freq_table_xg[p->freq2];
|
|
p->eq2p.gain = p->gain2 - 0x40;
|
|
calc_filter_peaking(&(p->eq2p));
|
|
}
|
|
else { p->valid2 = 0; }
|
|
if (p->freq3 != 0 && p->freq3 < 60 && p->gain3 != 0x40) {
|
|
p->valid3 = 1;
|
|
p->eq3p.q = (double)p->q3 / 10.0;
|
|
p->eq4p.freq = eq_freq_table_xg[p->freq3];
|
|
p->eq4p.gain = p->gain3 - 0x40;
|
|
calc_filter_peaking(&(p->eq3p));
|
|
}
|
|
else { p->valid3 = 0; }
|
|
if (p->freq4 != 0 && p->freq4 < 60 && p->gain4 != 0x40) {
|
|
p->valid4 = 1;
|
|
p->eq4p.q = (double)p->q4 / 10.0;
|
|
p->eq4p.freq = eq_freq_table_xg[p->freq4];
|
|
p->eq4p.gain = p->gain4 - 0x40;
|
|
calc_filter_peaking(&(p->eq4p));
|
|
}
|
|
else { p->valid4 = 0; }
|
|
if (p->freq5 != 0 && p->freq5 < 60 && p->gain5 != 0x40) {
|
|
p->valid5 = 1;
|
|
if (p->shape5) { /* peaking */
|
|
p->eq5p.q = (double)p->q5 / 10.0;
|
|
p->eq5p.freq = eq_freq_table_xg[p->freq5];
|
|
p->eq5p.gain = p->gain5 - 0x40;
|
|
calc_filter_peaking(&(p->eq5p));
|
|
}
|
|
else { /* shelving */
|
|
p->eq5s.q = (double)p->q5 / 10.0;
|
|
p->eq5s.freq = eq_freq_table_xg[p->freq5];
|
|
p->eq5s.gain = p->gain5 - 0x40;
|
|
calc_filter_shelving_high(&(p->eq5s));
|
|
}
|
|
}
|
|
else { p->valid5 = 0; }
|
|
p->valid = p->valid1 || p->valid2 || p->valid3 || p->valid4 || p->valid5;
|
|
}
|
|
|
|
void Reverb::set_effect_param_xg(struct effect_xg_t *st, int type_msb, int type_lsb)
|
|
{
|
|
int i, j;
|
|
for (i = 0; effect_parameter_xg[i].type_msb != -1
|
|
&& effect_parameter_xg[i].type_lsb != -1; i++) {
|
|
if (type_msb == effect_parameter_xg[i].type_msb
|
|
&& type_lsb == effect_parameter_xg[i].type_lsb) {
|
|
for (j = 0; j < 16; j++) {
|
|
st->param_lsb[j] = effect_parameter_xg[i].param_lsb[j];
|
|
}
|
|
for (j = 0; j < 10; j++) {
|
|
st->param_msb[j] = effect_parameter_xg[i].param_msb[j];
|
|
}
|
|
//printMessage(CMSG_INFO,VERB_NOISY,"XG EFX: %s", effect_parameter_xg[i].name);
|
|
return;
|
|
}
|
|
}
|
|
if (type_msb != 0) {
|
|
for (i = 0; effect_parameter_xg[i].type_msb != -1
|
|
&& effect_parameter_xg[i].type_lsb != -1; i++) {
|
|
if (type_lsb == effect_parameter_xg[i].type_lsb) {
|
|
for (j = 0; j < 16; j++) {
|
|
st->param_lsb[j] = effect_parameter_xg[i].param_lsb[j];
|
|
}
|
|
for (j = 0; j < 10; j++) {
|
|
st->param_msb[j] = effect_parameter_xg[i].param_msb[j];
|
|
}
|
|
//printMessage(CMSG_INFO,VERB_NOISY,"XG EFX: %s", effect_parameter_xg[i].name);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/*! recompute XG effect parameters. */
|
|
void Reverb::recompute_effect_xg(struct effect_xg_t *st)
|
|
{
|
|
EffectList *efc = st->ef;
|
|
|
|
if (efc == NULL) { return; }
|
|
while (efc != NULL && efc->info != NULL)
|
|
{
|
|
(this->*(efc->engine->conv_xg))(st, efc);
|
|
(this->*(efc->engine->do_effect))(NULL, MAGIC_INIT_EFFECT_INFO, efc);
|
|
efc = efc->next_ef;
|
|
}
|
|
}
|
|
|
|
void Reverb::realloc_effect_xg(struct effect_xg_t *st)
|
|
{
|
|
int type_msb = st->type_msb, type_lsb = st->type_lsb;
|
|
|
|
free_effect_list(st->ef);
|
|
st->ef = NULL;
|
|
st->use_msb = 0;
|
|
|
|
switch (type_msb) {
|
|
case 0x05:
|
|
st->use_msb = 1;
|
|
st->ef = push_effect(st->ef, EFFECT_DELAY_LCR);
|
|
st->ef = push_effect(st->ef, EFFECT_DELAY_EQ2);
|
|
break;
|
|
case 0x06:
|
|
st->use_msb = 1;
|
|
st->ef = push_effect(st->ef, EFFECT_DELAY_LR);
|
|
st->ef = push_effect(st->ef, EFFECT_DELAY_EQ2);
|
|
break;
|
|
case 0x07:
|
|
st->use_msb = 1;
|
|
st->ef = push_effect(st->ef, EFFECT_ECHO);
|
|
st->ef = push_effect(st->ef, EFFECT_DELAY_EQ2);
|
|
break;
|
|
case 0x08:
|
|
st->use_msb = 1;
|
|
st->ef = push_effect(st->ef, EFFECT_CROSS_DELAY);
|
|
st->ef = push_effect(st->ef, EFFECT_DELAY_EQ2);
|
|
break;
|
|
case 0x41:
|
|
case 0x42:
|
|
st->ef = push_effect(st->ef, EFFECT_CHORUS);
|
|
st->ef = push_effect(st->ef, EFFECT_CHORUS_EQ3);
|
|
break;
|
|
case 0x43:
|
|
st->ef = push_effect(st->ef, EFFECT_FLANGER);
|
|
st->ef = push_effect(st->ef, EFFECT_CHORUS_EQ3);
|
|
break;
|
|
case 0x44:
|
|
st->ef = push_effect(st->ef, EFFECT_SYMPHONIC);
|
|
st->ef = push_effect(st->ef, EFFECT_CHORUS_EQ3);
|
|
break;
|
|
case 0x49:
|
|
st->ef = push_effect(st->ef, EFFECT_STEREO_DISTORTION);
|
|
st->ef = push_effect(st->ef, EFFECT_OD_EQ3);
|
|
break;
|
|
case 0x4A:
|
|
st->ef = push_effect(st->ef, EFFECT_STEREO_OVERDRIVE);
|
|
st->ef = push_effect(st->ef, EFFECT_OD_EQ3);
|
|
break;
|
|
case 0x4B:
|
|
st->ef = push_effect(st->ef, EFFECT_STEREO_AMP_SIMULATOR);
|
|
break;
|
|
case 0x4C:
|
|
st->ef = push_effect(st->ef, EFFECT_EQ3);
|
|
break;
|
|
case 0x4D:
|
|
st->ef = push_effect(st->ef, EFFECT_EQ2);
|
|
break;
|
|
case 0x4E:
|
|
if (type_lsb == 0x01 || type_lsb == 0x02) {
|
|
st->ef = push_effect(st->ef, EFFECT_XG_AUTO_WAH);
|
|
st->ef = push_effect(st->ef, EFFECT_XG_AUTO_WAH_EQ2);
|
|
st->ef = push_effect(st->ef, EFFECT_XG_AUTO_WAH_OD);
|
|
st->ef = push_effect(st->ef, EFFECT_XG_AUTO_WAH_OD_EQ3);
|
|
}
|
|
else {
|
|
st->ef = push_effect(st->ef, EFFECT_XG_AUTO_WAH);
|
|
st->ef = push_effect(st->ef, EFFECT_XG_AUTO_WAH_EQ2);
|
|
}
|
|
break;
|
|
case 0x5E:
|
|
st->ef = push_effect(st->ef, EFFECT_LOFI);
|
|
break;
|
|
default: /* Not Supported */
|
|
type_msb = type_lsb = 0;
|
|
break;
|
|
}
|
|
set_effect_param_xg(st, type_msb, type_lsb);
|
|
recompute_effect_xg(st);
|
|
}
|
|
|
|
void Reverb::init_effect_xg(struct effect_xg_t *st)
|
|
{
|
|
int i;
|
|
|
|
free_effect_list(st->ef);
|
|
st->ef = NULL;
|
|
|
|
st->use_msb = 0;
|
|
st->type_msb = st->type_lsb = st->connection =
|
|
st->send_reverb = st->send_chorus = 0;
|
|
st->part = 0x7f;
|
|
st->ret = st->pan = st->mw_depth = st->bend_depth = st->cat_depth =
|
|
st->ac1_depth = st->ac2_depth = st->cbc1_depth = st->cbc2_depth = 0x40;
|
|
for (i = 0; i < 16; i++) { st->param_lsb[i] = 0; }
|
|
for (i = 0; i < 10; i++) { st->param_msb[i] = 0; }
|
|
}
|
|
|
|
/*! initialize XG effect parameters */
|
|
void Reverb::init_all_effect_xg(void)
|
|
{
|
|
int i;
|
|
init_effect_xg(&reverb_status_xg);
|
|
reverb_status_xg.type_msb = 0x01;
|
|
reverb_status_xg.connection = XG_CONN_SYSTEM_REVERB;
|
|
realloc_effect_xg(&reverb_status_xg);
|
|
init_effect_xg(&chorus_status_xg);
|
|
chorus_status_xg.type_msb = 0x41;
|
|
chorus_status_xg.connection = XG_CONN_SYSTEM_CHORUS;
|
|
realloc_effect_xg(&chorus_status_xg);
|
|
for (i = 0; i < XG_VARIATION_EFFECT_NUM; i++) {
|
|
init_effect_xg(&variation_effect_xg[i]);
|
|
variation_effect_xg[i].type_msb = 0x05;
|
|
realloc_effect_xg(&variation_effect_xg[i]);
|
|
}
|
|
for (i = 0; i < XG_INSERTION_EFFECT_NUM; i++) {
|
|
init_effect_xg(&insertion_effect_xg[i]);
|
|
insertion_effect_xg[i].type_msb = 0x49;
|
|
realloc_effect_xg(&insertion_effect_xg[i]);
|
|
}
|
|
init_ch_effect_xg();
|
|
}
|
|
|
|
/*! initialize GS insertion effect parameters */
|
|
void Reverb::init_insertion_effect_gs(void)
|
|
{
|
|
int i;
|
|
struct insertion_effect_gs_t *st = &insertion_effect_gs;
|
|
|
|
free_effect_list(st->ef);
|
|
st->ef = NULL;
|
|
|
|
for (i = 0; i < 20; i++) { st->parameter[i] = 0; }
|
|
|
|
st->type = 0;
|
|
st->type_lsb = 0;
|
|
st->type_msb = 0;
|
|
st->send_reverb = 0x28;
|
|
st->send_chorus = 0;
|
|
st->send_delay = 0;
|
|
st->control_source1 = 0;
|
|
st->control_depth1 = 0x40;
|
|
st->control_source2 = 0;
|
|
st->control_depth2 = 0x40;
|
|
st->send_eq_switch = 0x01;
|
|
}
|
|
|
|
void Reverb::set_effect_param_gs(struct insertion_effect_gs_t *st, int msb, int lsb)
|
|
{
|
|
int i, j;
|
|
for (i = 0; effect_parameter_gs[i].type_msb != -1
|
|
&& effect_parameter_gs[i].type_lsb != -1; i++) {
|
|
if (msb == effect_parameter_gs[i].type_msb
|
|
&& lsb == effect_parameter_gs[i].type_lsb) {
|
|
for (j = 0; j < 20; j++) {
|
|
st->parameter[j] = effect_parameter_gs[i].param[j];
|
|
}
|
|
//printMessage(CMSG_INFO,VERB_NOISY,"GS EFX: %s", effect_parameter_gs[i].name);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
/*! recompute GS insertion effect parameters. */
|
|
void Reverb::recompute_insertion_effect_gs(void)
|
|
{
|
|
struct insertion_effect_gs_t *st = &insertion_effect_gs;
|
|
EffectList *efc = st->ef;
|
|
|
|
if (st->ef == NULL) { return; }
|
|
while (efc != NULL && efc->info != NULL)
|
|
{
|
|
(this->*(efc->engine->conv_gs))(st, efc);
|
|
(this->*(efc->engine->do_effect))(NULL, MAGIC_INIT_EFFECT_INFO, efc);
|
|
efc = efc->next_ef;
|
|
}
|
|
}
|
|
|
|
/*! re-allocate GS insertion effect parameters. */
|
|
void Reverb::realloc_insertion_effect_gs(void)
|
|
{
|
|
struct insertion_effect_gs_t *st = &insertion_effect_gs;
|
|
int type_msb = st->type_msb, type_lsb = st->type_lsb;
|
|
|
|
free_effect_list(st->ef);
|
|
st->ef = NULL;
|
|
|
|
switch (type_msb) {
|
|
case 0x01:
|
|
switch (type_lsb) {
|
|
case 0x00: /* Stereo-EQ */
|
|
st->ef = push_effect(st->ef, EFFECT_STEREO_EQ);
|
|
break;
|
|
case 0x10: /* Overdrive */
|
|
st->ef = push_effect(st->ef, EFFECT_EQ2);
|
|
st->ef = push_effect(st->ef, EFFECT_OVERDRIVE1);
|
|
break;
|
|
case 0x11: /* Distortion */
|
|
st->ef = push_effect(st->ef, EFFECT_EQ2);
|
|
st->ef = push_effect(st->ef, EFFECT_DISTORTION1);
|
|
break;
|
|
case 0x40: /* Hexa Chorus */
|
|
st->ef = push_effect(st->ef, EFFECT_EQ2);
|
|
st->ef = push_effect(st->ef, EFFECT_HEXA_CHORUS);
|
|
break;
|
|
case 0x72: /* Lo-Fi 1 */
|
|
st->ef = push_effect(st->ef, EFFECT_EQ2);
|
|
st->ef = push_effect(st->ef, EFFECT_LOFI1);
|
|
break;
|
|
case 0x73: /* Lo-Fi 2 */
|
|
st->ef = push_effect(st->ef, EFFECT_EQ2);
|
|
st->ef = push_effect(st->ef, EFFECT_LOFI2);
|
|
break;
|
|
default: break;
|
|
}
|
|
break;
|
|
case 0x11:
|
|
switch (type_lsb) {
|
|
case 0x03: /* OD1 / OD2 */
|
|
st->ef = push_effect(st->ef, EFFECT_OD1OD2);
|
|
break;
|
|
default: break;
|
|
}
|
|
break;
|
|
default: break;
|
|
}
|
|
|
|
set_effect_param_gs(st, type_msb, type_lsb);
|
|
|
|
recompute_insertion_effect_gs();
|
|
}
|
|
|
|
void Reverb::init_effect_status(int play_system_mode)
|
|
{
|
|
free_effect_buffers();
|
|
init_reverb_status_gs();
|
|
init_delay_status_gs();
|
|
init_chorus_status_gs();
|
|
init_eq_status_gs();
|
|
init_insertion_effect_gs();
|
|
init_multi_eq_xg();
|
|
if (play_system_mode == XG_SYSTEM_MODE) { init_all_effect_xg(); }
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////////
|
|
}
|