0
1
mirror of https://github.com/radio95-rnt/fm95.git synced 2026-02-27 03:23:54 +01:00

i hate this with a passion

This commit is contained in:
2025-01-31 19:27:22 +01:00
parent 2283f5c0ca
commit a2217ecb5e
3 changed files with 17 additions and 50 deletions

View File

@@ -1,51 +1,13 @@
#include "filters.h"
void init_preemphasis(BiquadFilter *filter, float tau, float sample_rate) {
/*
premphasis should go like this:
cutoff: +0
2cutoff: +6
3cutoff: +12
4cutoff: +18
...
*/
// Calculate the cutoff frequency from tau (f_c = 1/(2πτ))
float cutoff_freq = 1.0f / (2.0f * M_PI * tau);
// Pre-warp the cutoff frequency for the bilinear transform
float omega = 2.0f * M_PI * cutoff_freq / sample_rate;
float K = tanf(omega / 2.0f);
// Calculate filter coefficients for 1st-order high-pass (converted to biquad)
float alpha = 1.0f + K;
filter->b0 = 1.0f / alpha;
filter->b1 = -filter->b0;
filter->b2 = 0.0f;
filter->a1 = (K - 1.0f) / alpha;
filter->a2 = 0.0f;
// Reset state variables
filter->x1 = 0.0f;
filter->x2 = 0.0f;
filter->y1 = 0.0f;
filter->y2 = 0.0f;
void init_preemphasis(ResistorCapacitor *filter, float tau, float sample_rate) {
filter->prev_sample = 0.0f;
filter->alpha = exp(-1 / (tau*sample_rate));
}
float apply_preemphasis(BiquadFilter *filter, float input) {
// Direct Form I implementation
float output = filter->b0 * input
+ filter->b1 * filter->x1
+ filter->b2 * filter->x2
- filter->a1 * filter->y1
- filter->a2 * filter->y2;
// Update state variables
filter->x2 = filter->x1;
filter->x1 = input;
filter->y2 = filter->y1;
filter->y1 = output;
return output;
float apply_preemphasis(ResistorCapacitor *filter, float sample) {
float out = sample-filter->alpha*filter->prev_sample;
filter->prev_sample = sample;
return out;
}
void init_lpf(BiquadFilter* filter, float cutoffFreq, float qFactor, float sampleRate) {