SHOW:
|
|
- or go back to the newest paste.
| 1 | static void | |
| 2 | run(LV2_Handle instance, | |
| 3 | uint32_t n_samples) | |
| 4 | {
| |
| 5 | Denoiser* denoiser = (Denoiser*)instance; | |
| 6 | ||
| 7 | const float* const input_left = denoiser->input_left; | |
| 8 | const float* const input_right = denoiser->input_right; | |
| 9 | float* const output_left = denoiser->output_left; | |
| 10 | float* const output_right = denoiser->output_right; | |
| 11 | ||
| 12 | const float sample_rate = denoiser->sample_rate; | |
| 13 | ||
| 14 | float bw = *(denoiser->bandwidth); | |
| 15 | float freq = *(denoiser->center_freq); | |
| 16 | float k; // intermediate variable for calculating coefficients | |
| 17 | float r; // ^ | |
| 18 | float a0,a1,a2,b1,b2; // IIR filter coefficients | |
| 19 | float o_lb1,o_lb2, o_rb1, o_rb2; // previous left and right outputs | |
| 20 | float i_lb1, i_lb2, i_rb1, i_rb2; // previous left and right inputs | |
| 21 | ||
| 22 | r = 1 - (3*(bw/sample_rate)); | |
| 23 | k = ( 1 - (2*r*cos(2*PI*(freq/sample_rate))) + (r*r) ) / ( 2 - (2*PI*(freq/sample_rate)) ); | |
| 24 | ||
| 25 | a0 = k; | |
| 26 | a1 = -2*k*cos(2*PI*(freq/sample_rate)); | |
| 27 | a2 = k; | |
| 28 | b1 = 2*r*cos(2*PI*(freq/sample_rate)); | |
| 29 | b2 = -1*(r*r); | |
| 30 | ||
| 31 | o_lb1 = denoiser->o_lb1; | |
| 32 | o_lb2 = denoiser->o_lb2; | |
| 33 | o_rb1 = denoiser->o_rb1; | |
| 34 | o_rb2 = denoiser->o_rb2; | |
| 35 | ||
| 36 | i_lb1 = denoiser->i_lb1; | |
| 37 | i_lb2 = denoiser->i_lb2; | |
| 38 | i_rb1 = denoiser->i_rb1; | |
| 39 | i_rb2 = denoiser->i_rb2; | |
| 40 | ||
| 41 | for(int i = 0; i < n_samples ; i ++){
| |
| 42 | - | output_left[i] = (a0*input_left[i]) + (a1*i_lb1) + (a2*i_lb2) + (b1*o_lb1) + (b2*o_lb2); |
| 42 | + | const float inL = input_left[i]; |
| 43 | const float inR = input_right[i]; | |
| 44 | - | denoiser->i_lb2 = i_lb1; |
| 44 | + | |
| 45 | - | denoiser->i_lb1 = input_left[i]; |
| 45 | + | output_left[i] = (a0*inL) + (a1*i_lb1) + (a2*i_lb2) + (b1*o_lb1) + (b2*o_lb2); |
| 46 | - | denoiser->o_lb2 = o_lb1; |
| 46 | + | |
| 47 | - | denoiser->o_lb1 = output_left[i]; |
| 47 | + | i_lb2 = i_lb1; |
| 48 | i_lb1 = inL; | |
| 49 | - | output_right[i] = (a0*input_right[i]) + (a1*i_rb1) + (a2*i_rb2) + (b1*o_rb1) + (b2*o_rb2); |
| 49 | + | o_lb2 = o_lb1; |
| 50 | o_lb1 = output_left[i]; | |
| 51 | - | denoiser->i_rb2 = i_rb1; |
| 51 | + | |
| 52 | - | denoiser->i_rb1 = input_right[i]; |
| 52 | + | output_right[i] = (a0*inR) + (a1*i_rb1) + (a2*i_rb2) + (b1*o_rb1) + (b2*o_rb2); |
| 53 | - | denoiser->o_rb2 = o_rb1; |
| 53 | + | |
| 54 | - | denoiser->o_rb1 = output_right[i]; |
| 54 | + | i_rb2 = i_rb1; |
| 55 | i_rb1 = inR; | |
| 56 | o_rb2 = o_rb1; | |
| 57 | o_rb1 = output_right[i]; | |
| 58 | } | |
| 59 | ||
| 60 | denoiser->i_lb2 = i_lb1; | |
| 61 | denoiser->i_lb1 = i_lb1; | |
| 62 | denoiser->o_lb2 = o_lb1; | |
| 63 | denoiser->o_lb1 = o_lb1; | |
| 64 | ||
| 65 | denoiser->i_rb2 = i_rb1; | |
| 66 | denoiser->i_rb1 = i_rb1; | |
| 67 | denoiser->o_rb2 = o_rb1; | |
| 68 | denoiser->o_rb1 = o_rb1; | |
| 69 | } |