qualia_audio/features/
cqt.rs1use crate::types::AudioError;
4
5pub fn forward_cqt_mono(
7 samples: &[f32],
8 sample_rate: f32,
9 f_min: f32,
10 bins_per_octave: usize,
11 n_bins: usize,
12 out: &mut [f32],
13) -> Result<(), AudioError> {
14 if out.len() < n_bins || bins_per_octave == 0 || sample_rate <= 0.0 || f_min <= 0.0 {
15 return Err(AudioError::MalformedAudio);
16 }
17 if samples.is_empty() {
18 out[..n_bins].fill(0.0);
19 return Ok(());
20 }
21 let q = 1.0_f32 / (2.0_f32.powf(1.0 / bins_per_octave as f32) - 1.0);
22 for k in 0..n_bins {
23 let f_k = f_min * 2.0_f32.powf(k as f32 / bins_per_octave as f32);
24 let nk = ((q * sample_rate / f_k).round() as usize).clamp(32, samples.len());
25 let start = samples.len().saturating_sub(nk) / 2;
27 let mut acc_re = 0.0f32;
28 let mut acc_im = 0.0f32;
29 for j in 0..nk {
30 let w = if nk <= 1 {
31 1.0
32 } else {
33 0.5 * (1.0 - (core::f32::consts::TAU * j as f32 / (nk - 1) as f32).cos())
34 };
35 let theta = -core::f32::consts::TAU * f_k * j as f32 / sample_rate;
36 let s = samples[start + j] * w;
37 acc_re += s * theta.cos();
38 acc_im += s * theta.sin();
39 }
40 let inv = 1.0 / nk as f32;
41 out[k] = ((acc_re * inv).powi(2) + (acc_im * inv).powi(2)).sqrt();
42 }
43 Ok(())
44}
45
46#[cfg(test)]
47mod tests {
48 use super::*;
49
50 #[test]
51 fn cqt_nonzero_on_tone() {
52 let sr = 16000.0f32;
53 let n = 4096;
54 let mut s = vec![0.0f32; n];
55 for i in 0..n {
56 s[i] = (core::f32::consts::TAU * 440.0 * i as f32 / sr).sin();
57 }
58 let mut out = [0.0f32; 24];
59 forward_cqt_mono(&s, sr, 55.0, 12, 24, &mut out).unwrap();
60 assert!(out.iter().cloned().fold(0.0f32, f32::max) > 1e-6);
61 }
62}