Skip to main content

qualia_audio/features/
cqt.rs

1//! CPU constant-Q magnitude spectrum (cold/stream-friendly block).
2
3use crate::types::AudioError;
4
5/// Forward CQT magnitudes for mono `samples` (one vector of `n_bins`).
6pub 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        // Center window in the buffer for better tone response.
26        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}