ref: 29851f9c445d41cd82e422cb4b8c13fd2a13aea5
dir: /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() { 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) { sp_phaser *p = ui_interface; p->args[p->argpos] = zone; p->argpos++; } static void addCheckButton (void* ui_interface, const char* label, FAUSTFLOAT* zone) { 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) { phaser *dsp = p->faust; SPFLOAT *faust_out[] = {out1, out2}; SPFLOAT *faust_in[] = {in1, in2}; computephaser(dsp, 1, faust_in, faust_out); return SP_OK; }