ref: 25a9fcc24ad00c6a406042818b9e6f2e7bba0dd1
dir: soundpipe/modules/phaser.c
#include <stdlib.h>
#include <math.h>
#include "soundpipe.h"
#include "CUI.h"
#ifndef FAUSTFLOAT
#define FAUSTFLOAT float
#endif
#define max(a,b) ((a < b) ? b : a)
#define min(a,b) ((a < b) ? a : b)
static float faustpower2_f(float value) {
return (value * value);
}
static float faustpower3_f(float value) {
return ((value * value) * value);
}
static float faustpower4_f(float value) {
return (((value * value) * value) * value);
}
typedef struct {
float fRec4[3];
float fRec3[3];
float fRec2[3];
float fRec1[3];
float fRec11[3];
float fRec10[3];
float fRec9[3];
float fRec8[3];
int iVec0[2];
float fRec5[2];
float fRec6[2];
float fRec0[2];
float fRec7[2];
FAUSTFLOAT fHslider0;
FAUSTFLOAT fCheckbox0;
FAUSTFLOAT fHslider1;
int fSamplingFreq;
int iConst0;
float fConst1;
FAUSTFLOAT fHslider2;
FAUSTFLOAT fHslider3;
FAUSTFLOAT fHslider4;
FAUSTFLOAT fHslider5;
float fConst2;
FAUSTFLOAT fHslider6;
FAUSTFLOAT fHslider7;
FAUSTFLOAT fCheckbox1;
} phaser;
phaser* newphaser(void) {
phaser* dsp = (phaser*)malloc(sizeof(phaser));
return dsp;
}
void deletephaser(phaser* dsp) {
free(dsp);
}
void instanceInitphaser(phaser* dsp, int samplingFreq) {
dsp->fSamplingFreq = samplingFreq;
dsp->fHslider0 = (FAUSTFLOAT)0.;
/* C99 loop */
{
int i0;
for (i0 = 0; (i0 < 2); i0 = (i0 + 1)) {
dsp->iVec0[i0] = 0;
}
}
dsp->fCheckbox0 = (FAUSTFLOAT)0.;
dsp->fHslider1 = (FAUSTFLOAT)1.;
dsp->iConst0 = min(192000, max(1, dsp->fSamplingFreq));
dsp->fConst1 = (1.f / (float)dsp->iConst0);
dsp->fHslider2 = (FAUSTFLOAT)1000.;
dsp->fHslider3 = (FAUSTFLOAT)1.5;
dsp->fHslider4 = (FAUSTFLOAT)100.;
dsp->fHslider5 = (FAUSTFLOAT)800.;
dsp->fConst2 = (0.10472f / (float)dsp->iConst0);
dsp->fHslider6 = (FAUSTFLOAT)30.;
/* C99 loop */
{
int i1;
for (i1 = 0; (i1 < 2); i1 = (i1 + 1)) {
dsp->fRec5[i1] = 0.f;
}
}
/* C99 loop */
{
int i2;
for (i2 = 0; (i2 < 2); i2 = (i2 + 1)) {
dsp->fRec6[i2] = 0.f;
}
}
dsp->fHslider7 = (FAUSTFLOAT)0.;
/* C99 loop */
{
int i3;
for (i3 = 0; (i3 < 3); i3 = (i3 + 1)) {
dsp->fRec4[i3] = 0.f;
}
}
/* C99 loop */
{
int i4;
for (i4 = 0; (i4 < 3); i4 = (i4 + 1)) {
dsp->fRec3[i4] = 0.f;
}
}
/* C99 loop */
{
int i5;
for (i5 = 0; (i5 < 3); i5 = (i5 + 1)) {
dsp->fRec2[i5] = 0.f;
}
}
/* C99 loop */
{
int i6;
for (i6 = 0; (i6 < 3); i6 = (i6 + 1)) {
dsp->fRec1[i6] = 0.f;
}
}
/* C99 loop */
{
int i7;
for (i7 = 0; (i7 < 2); i7 = (i7 + 1)) {
dsp->fRec0[i7] = 0.f;
}
}
dsp->fCheckbox1 = (FAUSTFLOAT)0.;
/* C99 loop */
{
int i8;
for (i8 = 0; (i8 < 3); i8 = (i8 + 1)) {
dsp->fRec11[i8] = 0.f;
}
}
/* C99 loop */
{
int i9;
for (i9 = 0; (i9 < 3); i9 = (i9 + 1)) {
dsp->fRec10[i9] = 0.f;
}
}
/* C99 loop */
{
int i10;
for (i10 = 0; (i10 < 3); i10 = (i10 + 1)) {
dsp->fRec9[i10] = 0.f;
}
}
/* C99 loop */
{
int i11;
for (i11 = 0; (i11 < 3); i11 = (i11 + 1)) {
dsp->fRec8[i11] = 0.f;
}
}
/* C99 loop */
{
int i12;
for (i12 = 0; (i12 < 2); i12 = (i12 + 1)) {
dsp->fRec7[i12] = 0.f;
}
}
}
void initphaser(phaser* dsp, int samplingFreq) {
instanceInitphaser(dsp, samplingFreq);
}
void buildUserInterfacephaser(phaser* dsp, UIGlue* interface) {
interface->addHorizontalSlider(interface->uiInterface, "MaxNotch1Freq", &dsp->fHslider5, 800.f, 20.f, 10000.f, 1.f);
interface->addHorizontalSlider(interface->uiInterface, "MinNotch1Freq", &dsp->fHslider4, 100.f, 20.f, 5000.f, 1.f);
interface->addHorizontalSlider(interface->uiInterface, "Notch width", &dsp->fHslider2, 1000.f, 10.f, 5000.f, 1.f);
interface->addHorizontalSlider(interface->uiInterface, "NotchFreq", &dsp->fHslider3, 1.5f, 1.1f, 4.f, 0.01f);
interface->addCheckButton(interface->uiInterface, "VibratoMode", &dsp->fCheckbox0);
interface->addHorizontalSlider(interface->uiInterface, "depth", &dsp->fHslider1, 1.f, 0.f, 1.f, 0.01f);
interface->addHorizontalSlider(interface->uiInterface, "feedback gain", &dsp->fHslider7, 0.f, 0.f, 1.f, 0.01f);
interface->addCheckButton(interface->uiInterface, "invert", &dsp->fCheckbox1);
interface->addHorizontalSlider(interface->uiInterface, "level", &dsp->fHslider0, 0.f, -60.f, 10.f, 0.1f);
interface->addHorizontalSlider(interface->uiInterface, "lfobpm", &dsp->fHslider6, 30.f, 24.f, 360.f, 1.f);
}
void computephaser(phaser* dsp, int count, FAUSTFLOAT** inputs, FAUSTFLOAT** outputs) {
FAUSTFLOAT* input0 = inputs[0];
FAUSTFLOAT* input1 = inputs[1];
FAUSTFLOAT* output0 = outputs[0];
FAUSTFLOAT* output1 = outputs[1];
float fSlow0 = pow(10.f, (0.05f * (float)dsp->fHslider0));
float fSlow1 = (0.5f * ((int)(float)dsp->fCheckbox0?2.f:(float)dsp->fHslider1));
float fSlow2 = (1.f - fSlow1);
float fSlow3 = exp((dsp->fConst1 * (0.f - (3.14159f * (float)dsp->fHslider2))));
float fSlow4 = faustpower2_f(fSlow3);
float fSlow5 = (0.f - (2.f * fSlow3));
float fSlow6 = (float)dsp->fHslider3;
float fSlow7 = (dsp->fConst1 * fSlow6);
float fSlow8 = (float)dsp->fHslider4;
float fSlow9 = (6.28319f * fSlow8);
float fSlow10 = (0.5f * ((6.28319f * max(fSlow8, (float)dsp->fHslider5)) - fSlow9));
float fSlow11 = (dsp->fConst2 * (float)dsp->fHslider6);
float fSlow12 = sin(fSlow11);
float fSlow13 = cos(fSlow11);
float fSlow14 = (0.f - fSlow12);
float fSlow15 = (float)dsp->fHslider7;
float fSlow16 = (dsp->fConst1 * faustpower2_f(fSlow6));
float fSlow17 = (dsp->fConst1 * faustpower3_f(fSlow6));
float fSlow18 = (dsp->fConst1 * faustpower4_f(fSlow6));
float fSlow19 = ((int)(float)dsp->fCheckbox1?(0.f - fSlow1):fSlow1);
/* C99 loop */
{
int i;
for (i = 0; (i < count); i = (i + 1)) {
dsp->iVec0[0] = 1;
float fTemp0 = (float)input0[i];
dsp->fRec5[0] = ((fSlow12 * dsp->fRec6[1]) + (fSlow13 * dsp->fRec5[1]));
dsp->fRec6[0] = ((1.f + ((fSlow13 * dsp->fRec6[1]) + (fSlow14 * dsp->fRec5[1]))) - (float)dsp->iVec0[1]);
float fTemp1 = ((fSlow10 * (1.f - dsp->fRec5[0])) + fSlow9);
float fTemp2 = (dsp->fRec4[1] * cos((fSlow7 * fTemp1)));
dsp->fRec4[0] = (0.f - (((fSlow5 * fTemp2) + (fSlow4 * dsp->fRec4[2])) - ((fSlow0 * fTemp0) + (fSlow15 * dsp->fRec0[1]))));
float fTemp3 = (dsp->fRec3[1] * cos((fSlow16 * fTemp1)));
dsp->fRec3[0] = ((fSlow5 * (fTemp2 - fTemp3)) + (dsp->fRec4[2] + (fSlow4 * (dsp->fRec4[0] - dsp->fRec3[2]))));
float fTemp4 = (dsp->fRec2[1] * cos((fSlow17 * fTemp1)));
dsp->fRec2[0] = ((fSlow5 * (fTemp3 - fTemp4)) + (dsp->fRec3[2] + (fSlow4 * (dsp->fRec3[0] - dsp->fRec2[2]))));
float fTemp5 = (dsp->fRec1[1] * cos((fSlow18 * fTemp1)));
dsp->fRec1[0] = ((fSlow5 * (fTemp4 - fTemp5)) + (dsp->fRec2[2] + (fSlow4 * (dsp->fRec2[0] - dsp->fRec1[2]))));
dsp->fRec0[0] = ((fSlow4 * dsp->fRec1[0]) + ((fSlow5 * fTemp5) + dsp->fRec1[2]));
output0[i] = (FAUSTFLOAT)((fSlow0 * (fSlow2 * fTemp0)) + (dsp->fRec0[0] * fSlow19));
float fTemp6 = (float)input1[i];
float fTemp7 = ((fSlow10 * (1.f - dsp->fRec6[0])) + fSlow9);
float fTemp8 = (dsp->fRec11[1] * cos((fSlow7 * fTemp7)));
dsp->fRec11[0] = (0.f - (((fSlow5 * fTemp8) + (fSlow4 * dsp->fRec11[2])) - ((fSlow0 * fTemp6) + (fSlow15 * dsp->fRec7[1]))));
float fTemp9 = (dsp->fRec10[1] * cos((fSlow16 * fTemp7)));
dsp->fRec10[0] = ((fSlow5 * (fTemp8 - fTemp9)) + (dsp->fRec11[2] + (fSlow4 * (dsp->fRec11[0] - dsp->fRec10[2]))));
float fTemp10 = (dsp->fRec9[1] * cos((fSlow17 * fTemp7)));
dsp->fRec9[0] = ((fSlow5 * (fTemp9 - fTemp10)) + (dsp->fRec10[2] + (fSlow4 * (dsp->fRec10[0] - dsp->fRec9[2]))));
float fTemp11 = (dsp->fRec8[1] * cos((fSlow18 * fTemp7)));
dsp->fRec8[0] = ((fSlow5 * (fTemp10 - fTemp11)) + (dsp->fRec9[2] + (fSlow4 * (dsp->fRec9[0] - dsp->fRec8[2]))));
dsp->fRec7[0] = ((fSlow4 * dsp->fRec8[0]) + ((fSlow5 * fTemp11) + dsp->fRec8[2]));
output1[i] = (FAUSTFLOAT)((fSlow0 * (fSlow2 * fTemp6)) + (dsp->fRec7[0] * fSlow19));
dsp->iVec0[1] = dsp->iVec0[0];
dsp->fRec5[1] = dsp->fRec5[0];
dsp->fRec6[1] = dsp->fRec6[0];
dsp->fRec4[2] = dsp->fRec4[1];
dsp->fRec4[1] = dsp->fRec4[0];
dsp->fRec3[2] = dsp->fRec3[1];
dsp->fRec3[1] = dsp->fRec3[0];
dsp->fRec2[2] = dsp->fRec2[1];
dsp->fRec2[1] = dsp->fRec2[0];
dsp->fRec1[2] = dsp->fRec1[1];
dsp->fRec1[1] = dsp->fRec1[0];
dsp->fRec0[1] = dsp->fRec0[0];
dsp->fRec11[2] = dsp->fRec11[1];
dsp->fRec11[1] = dsp->fRec11[0];
dsp->fRec10[2] = dsp->fRec10[1];
dsp->fRec10[1] = dsp->fRec10[0];
dsp->fRec9[2] = dsp->fRec9[1];
dsp->fRec9[1] = dsp->fRec9[0];
dsp->fRec8[2] = dsp->fRec8[1];
dsp->fRec8[1] = dsp->fRec8[0];
dsp->fRec7[1] = dsp->fRec7[0];
}
}
}
static void addHorizontalSlider(void* ui_interface, const char* label, FAUSTFLOAT* zone, FAUSTFLOAT init, FAUSTFLOAT min, FAUSTFLOAT max, FAUSTFLOAT step)
{
USED(label, init, min, max, step);
sp_phaser *p = ui_interface;
p->args[p->argpos] = zone;
p->argpos++;
}
static void addCheckButton (void* ui_interface, const char* label, FAUSTFLOAT* zone)
{
USED(label);
sp_phaser *p = ui_interface;
p->args[p->argpos] = zone;
p->argpos++;
}
int sp_phaser_create(sp_phaser **p)
{
*p = malloc(sizeof(sp_phaser));
return SP_OK;
}
int sp_phaser_destroy(sp_phaser **p)
{
sp_phaser *pp = *p;
phaser *dsp = pp->faust;
deletephaser (dsp);
free(*p);
return SP_OK;
}
int sp_phaser_init(sp_data *sp, sp_phaser *p)
{
phaser *dsp = newphaser();
UIGlue UI;
p->argpos = 0;
UI.addHorizontalSlider= addHorizontalSlider;
UI.addCheckButton = addCheckButton;
UI.uiInterface = p;
buildUserInterfacephaser(dsp, &UI);
initphaser(dsp, sp->sr);
p->MaxNotch1Freq = p->args[0];
p->MinNotch1Freq = p->args[1];
p->Notch_width = p->args[2];
p->NotchFreq = p->args[3];
p->VibratoMode = p->args[4];
p->depth = p->args[5];
p->feedback_gain = p->args[6];
p->invert = p->args[7];
p->level = p->args[8];
p->lfobpm = p->args[9];
p->faust = dsp;
return SP_OK;
}
int sp_phaser_compute(sp_data *sp, sp_phaser *p,
SPFLOAT *in1, SPFLOAT *in2, SPFLOAT *out1, SPFLOAT *out2)
{
USED(sp);
phaser *dsp = p->faust;
SPFLOAT *faust_out[] = {out1, out2};
SPFLOAT *faust_in[] = {in1, in2};
computephaser(dsp, 1, faust_in, faust_out);
return SP_OK;
}