126 lines
2.7 KiB
C
126 lines
2.7 KiB
C
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
#include "crap_util.h"
|
|
#include "param.h"
|
|
|
|
#define BANDS 4
|
|
|
|
#define ID 0x000CAFED
|
|
#define LABEL "crap_eq"
|
|
#define NAME "crap Parametric Equalizer"
|
|
#define AUTHOR "Connor Olding"
|
|
#define COPYRIGHT "MIT"
|
|
#define PARAMETERS (BANDS*3)
|
|
|
|
typedef struct {
|
|
biquad filters[2][BANDS];
|
|
float fs;
|
|
} personal;
|
|
|
|
static double
|
|
process_one(biquad *filters, double samp)
|
|
{
|
|
for (int i = 0; i < BANDS; i++)
|
|
samp = biquad_run(&filters[i], samp);
|
|
return samp;
|
|
}
|
|
|
|
static void
|
|
process(personal *data,
|
|
float *in_L, float *in_R,
|
|
float *out_L, float *out_R,
|
|
unsigned long count)
|
|
{
|
|
disable_denormals();
|
|
for (unsigned long pos = 0; pos < count; pos++) {
|
|
out_L[pos] = process_one(data->filters[0], in_L[pos]);
|
|
out_R[pos] = process_one(data->filters[1], in_R[pos]);
|
|
}
|
|
}
|
|
|
|
static void
|
|
process_double(personal *data,
|
|
double *in_L, double *in_R,
|
|
double *out_L, double *out_R,
|
|
unsigned long count)
|
|
{
|
|
disable_denormals();
|
|
for (unsigned long pos = 0; pos < count; pos++) {
|
|
out_L[pos] = process_one(data->filters[0], in_L[pos]);
|
|
out_R[pos] = process_one(data->filters[1], in_R[pos]);
|
|
}
|
|
}
|
|
|
|
static void
|
|
resume(personal *data)
|
|
{
|
|
biquad *filters = data->filters[0];
|
|
for (int i = 0; i < BANDS; i++)
|
|
biquad_init(&filters[i]);
|
|
memcpy(data->filters[1], filters, BANDS*sizeof(biquad));
|
|
}
|
|
|
|
static void
|
|
pause(personal *data)
|
|
{}
|
|
|
|
static void
|
|
construct_params(param *params)
|
|
{
|
|
for (int i = 0; i < BANDS; i++) {
|
|
sprintf(params[0].name, "Band %i Frequency", i + 1);
|
|
params[0].min = 20;
|
|
params[0].max = 20000;
|
|
params[0].scale = SCALE_HZ;
|
|
params[0].def = DEFAULT_440;
|
|
param_reset(¶ms[0]);
|
|
|
|
sprintf(params[1].name, "Band %i Gain", i + 1);
|
|
params[1].min = -18;
|
|
params[1].max = 18;
|
|
params[1].scale = SCALE_DB;
|
|
params[1].def = DEFAULT_0;
|
|
param_reset(¶ms[1]);
|
|
|
|
sprintf(params[2].name, "Band %i Bandwidth", i + 1);
|
|
params[2].min = 0.0625; // 2^-4 could probably be 2^-3
|
|
params[2].max = 8; // 2^3 could probably be 2^2
|
|
params[2].scale = SCALE_FLOAT;
|
|
params[2].def = DEFAULT_1;
|
|
param_reset(¶ms[2]);
|
|
|
|
params += 3;
|
|
}
|
|
}
|
|
|
|
static void
|
|
construct(personal *data)
|
|
{}
|
|
|
|
static void
|
|
destruct(personal *data)
|
|
{}
|
|
|
|
static void
|
|
adjust(personal *data, param *params, unsigned long fs)
|
|
{
|
|
data->fs = fs;
|
|
biquad *filters = data->filters[0];
|
|
for (int i = 0; i < BANDS; i++) {
|
|
filters[i] = biquad_gen(FILT_PEAKING,
|
|
params[0].value, params[1].value, params[2].value, fs);
|
|
params += 3;
|
|
}
|
|
resume(data);
|
|
}
|
|
|
|
static void
|
|
adjust_one(personal *data, param *params, unsigned int index)
|
|
{
|
|
float fs = data->fs;
|
|
params += index/3*3;
|
|
data->filters[0][index/3] = biquad_gen(FILT_PEAKING,
|
|
params[0].value, params[1].value, params[2].value, fs);
|
|
resume(data);
|
|
}
|