mirror of
https://github.com/radio95-rnt/fm95.git
synced 2026-02-27 03:23:54 +01:00
Update iir.c
This commit is contained in:
11
filter/iir.c
11
filter/iir.c
@@ -15,19 +15,14 @@ inline float apply_preemphasis(ResistorCapacitor *filter, float sample) {
|
|||||||
return out;
|
return out;
|
||||||
}
|
}
|
||||||
|
|
||||||
void tilt_init(TiltCorrectionFilter* filter, float cutoff_freq, float sample_rate) {
|
void tilt_init(TiltCorrectionFilter* filter, float alpha) {
|
||||||
// High-pass filter: H(z) = (1 - z^-1) / (1 - α*z^-1)
|
filter->alpha = alpha; // 0.95 to 0.99 typically
|
||||||
float dt = 1.0f / sample_rate;
|
|
||||||
float tau = 1.0f / (2.0f * M_PI * cutoff_freq);
|
|
||||||
float alpha = tau / (tau + dt);
|
|
||||||
|
|
||||||
filter->alpha = alpha;
|
|
||||||
filter->x_prev = 0.0f;
|
filter->x_prev = 0.0f;
|
||||||
filter->y_prev = 0.0f;
|
filter->y_prev = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
float tilt(TiltCorrectionFilter* filter, float input) {
|
float tilt(TiltCorrectionFilter* filter, float input) {
|
||||||
// High-pass filter: y[n] = α*y[n-1] + (x[n] - x[n-1])
|
// High-pass: y[n] = α*y[n-1] + (x[n] - x[n-1])
|
||||||
float output = filter->alpha * filter->y_prev + (input - filter->x_prev);
|
float output = filter->alpha * filter->y_prev + (input - filter->x_prev);
|
||||||
|
|
||||||
filter->x_prev = input;
|
filter->x_prev = input;
|
||||||
|
|||||||
Reference in New Issue
Block a user