Debian Codegraph @

plugins/LadspaEffect/swh/util/waveguide_nl.h

raw
1 #ifndef WAVEGUIDE_NL_H
2 #define WAVEGUIDE_NL_H
3
4 #include <stdlib.h>
5 #include <string.h>
6
7 typedef struct {
8 int size;
9 float *buffer[2];
10 int ptr;
11 int delay;
12 float fc;
13 float lp[2];
14 float a1a;
15 float a1b;
16 float zm1[2];
17 } waveguide_nl;
18
19 waveguide_nl *waveguide_nl_new(int size, float fc, float da, float db)
20 {
21 waveguide_nl *wg = malloc(sizeof(waveguide_nl));
22 wg->size = size;
23 wg->delay = size;
24 wg->buffer[0] = calloc(size, sizeof(float));
25 wg->buffer[1] = calloc(size, sizeof(float));
26 wg->ptr = 0;
27 wg->fc = fc;
28 wg->lp[0] = 0.0f;
29 wg->lp[1] = 0.0f;
30 wg->zm1[0] = 0.0f;
31 wg->zm1[1] = 0.0f;
32 wg->a1a = (1.0f - da) / (1.0f + da);
33 wg->a1b = (1.0f - db) / (1.0f + db);
34
35 return wg;
36 }
37
38 void waveguide_nl_reset(waveguide_nl *wg)
39 {
40 memset(wg->buffer[0], 0, wg->size * sizeof(float));
41 memset(wg->buffer[1], 0, wg->size * sizeof(float));
42 wg->lp[0] = 0.0f;
43 wg->lp[1] = 0.0f;
44 wg->zm1[0] = 0.0f;
45 wg->zm1[1] = 0.0f;
46 }
47
48 void waveguide_nl_free(waveguide_nl *wg)
49 {
50 if (!wg) {
51 return;
52 }
53 free(wg->buffer[0]);
54 free(wg->buffer[1]);
55 free(wg);
56 }
57
58 void waveguide_nl_set_delay(waveguide_nl *wg, int delay)
59 {
60 if (delay > wg->size) {
61 wg->delay = wg->size;
62 } else if (delay < 1) {
63 wg->delay = 1;
64 } else {
65 wg->delay = delay;
66 }
67 }
68
69 void waveguide_nl_set_fc(waveguide_nl *wg, float fc)
70 {
71 wg->fc = fc;
72 }
73
74 void waveguide_nl_set_ap(waveguide_nl *wg, float da, float db)
75 {
76 wg->a1a = (1.0f - da) / (1.0f + da);
77 wg->a1b = (1.0f - db) / (1.0f + db);
78 }
79
80 void waveguide_nl_process_lin(waveguide_nl *wg, float in0, float in1, float *out0, float *out1)
81 {
82 float tmp;
83
84 *out0 = wg->buffer[0][(wg->ptr + wg->delay) % wg->size];
85 *out0 = wg->lp[0] * (wg->fc - 1.0f) + wg->fc * *out0;
86 wg->lp[0] = *out0;
87 tmp = *out0 * -(wg->a1a) + wg->zm1[0];
88 wg->zm1[0] = tmp * wg->a1a + *out0;
89 *out0 = tmp;
90
91 *out1 = wg->buffer[1][(wg->ptr + wg->delay) % wg->size];
92 *out1 = wg->lp[1] * (wg->fc - 1.0f) + wg->fc * *out1;
93 wg->lp[1] = *out1;
94 tmp = *out1 * -(wg->a1a) + wg->zm1[1];
95 wg->zm1[1] = tmp * wg->a1a + *out1;
96 *out1 = tmp;
97
98 wg->buffer[0][wg->ptr] = in0;
99 wg->buffer[1][wg->ptr] = in1;
100 wg->ptr--;
101 if (wg->ptr < 0) {
102 wg->ptr += wg->size;
103 }
104 }
105
106 void waveguide_nl_process(waveguide_nl *wg, float in0, float in1, float *out0, float *out1)
107 {
108 float tmp;
109 float a1;
110 float b;
111
112 *out0 = wg->buffer[0][(wg->ptr + wg->delay) % wg->size];
113 *out0 = wg->lp[0] * (wg->fc - 1.0f) + wg->fc * *out0;
114 wg->lp[0] = *out0;
115 b = (*out0 + 1.0) * 6.0f;
116 if (b > 1.0f) {
117 b = 1.0f;
118 }
119 if (b < 0.0f) {
120 b = 0.0f;
121 }
122 a1 = b * wg->a1a + (1.0f - b) * wg->a1b;
123 tmp = *out0 * -a1 + wg->zm1[0];
124 wg->zm1[0] = tmp * a1 + *out0;
125 *out0 = tmp;
126
127 *out1 = wg->buffer[1][(wg->ptr + wg->delay) % wg->size];
128 *out1 = wg->lp[1] * (wg->fc - 1.0f) + wg->fc * *out1;
129 wg->lp[1] = *out1;
130 b = (*out1 + 1.0) * 6.0f;
131 if (b > 1.0f) {
132 b = 1.0f;
133 }
134 if (b < 0.0f) {
135 b = 0.0f;
136 }
137 a1 = b * wg->a1a + (1.0f - b) * wg->a1b;
138 tmp = *out1 * -a1 + wg->zm1[1];
139 wg->zm1[1] = tmp * a1 + *out1;
140 *out1 = tmp;
141
142 wg->buffer[0][wg->ptr] = in0;
143 wg->buffer[1][wg->ptr] = in1;
144 wg->ptr--;
145 if (wg->ptr < 0) {
146 wg->ptr += wg->size;
147 }
148 }
149
150 #endif