qualia_audio/features/filters/
bandreject.rs1use super::biquad::BiquadCoeffs;
4
5pub fn design_bandreject(sample_rate: f32, center_hz: f32, q: f32) -> BiquadCoeffs {
10 let sr = f64::from(if sample_rate > 1.0 { sample_rate } else { 1.0 });
11 let f0 = f64::from(center_hz).clamp(1.0e-4, sr * 0.5 * 0.999);
12 let q64 = f64::from(if q > 1.0e-4 { q } else { 1.0e-4 });
13 etalon_signal::filter::rbj_notch(sr, f0, q64)
14 .map(BiquadCoeffs::from_etalon)
15 .unwrap_or_else(|_| BiquadCoeffs::identity())
16}
17
18#[cfg(test)]
19mod tests {
20 use super::*;
21 use crate::features::filters::biquad::{BiquadCoeffs, BiquadState};
22
23 fn run_sine(sr: f32, freq: f32, c: &BiquadCoeffs) -> f32 {
24 let n = 16384usize;
25 let skip = 4096usize;
26 let mut st = BiquadState::new();
27 let mut acc_in = 0.0f32;
28 let mut acc_out = 0.0f32;
29 let mut cnt = 0.0f32;
30 for i in 0..n {
31 let x = (2.0 * core::f32::consts::PI * freq * i as f32 / sr).sin();
32 let y = st.process_sample(c, x);
33 if i >= skip {
34 acc_in += x * x;
35 acc_out += y * y;
36 cnt += 1.0;
37 }
38 }
39 (acc_out / cnt).sqrt() / (acc_in / cnt).sqrt()
40 }
41
42 #[test]
43 fn center_rejected_edges_pass() {
44 let center = 1_000.0;
45 let c = design_bandreject(48_000.0, center, 4.0);
46 let at_center = run_sine(48_000.0, center, &c);
47 let below = run_sine(48_000.0, 100.0, &c);
48 let above = run_sine(48_000.0, 10_000.0, &c);
49 assert!(at_center < 0.3, "center {at_center}");
50 assert!(below > 0.9 && below < 1.1, "below {below}");
51 assert!(above > 0.9 && above < 1.1, "above {above}");
52 }
53}