Skip to main content

qualia_vision/biosense/rppg/
chrom_rppg_trace.rs

1//! CHROM rPPG chrominance method (simplified).
2
3use crate::cv::error::CvError;
4
5/// CHROM rPPG trace.
6pub fn chrom_rppg_trace(
7    rgb_means: &[f32],
8    n_frames: usize,
9    out: &mut [f32],
10) -> Result<(), CvError> {
11    if n_frames == 0 || rgb_means.len() < n_frames * 3 || out.len() < n_frames {
12        return Err(CvError::BufferTooSmall);
13    }
14    let mut xs = 0.0f32;
15    let mut ys = 0.0f32;
16    let mut xbuf = vec![0.0f32; n_frames];
17    let mut ybuf = vec![0.0f32; n_frames];
18    for i in 0..n_frames {
19        let r = rgb_means[i * 3];
20        let g = rgb_means[i * 3 + 1];
21        let b = rgb_means[i * 3 + 2];
22        let x = 3.0 * r - 2.0 * g;
23        let y = 1.5 * r + g - 1.5 * b;
24        xbuf[i] = x;
25        ybuf[i] = y;
26        xs += x;
27        ys += y;
28    }
29    let n = n_frames as f32;
30    let xm = xs / n;
31    let ym = ys / n;
32    let mut xs2 = 0.0f32;
33    let mut ys2 = 0.0f32;
34    for i in 0..n_frames {
35        let xd = xbuf[i] - xm;
36        let yd = ybuf[i] - ym;
37        xs2 += xd * xd;
38        ys2 += yd * yd;
39    }
40    let sx = (xs2 / n).sqrt().max(1e-6);
41    let sy = (ys2 / n).sqrt().max(1e-6);
42    let alpha = sx / sy;
43    for i in 0..n_frames {
44        out[i] = (xbuf[i] - xm) - alpha * (ybuf[i] - ym);
45    }
46    Ok(())
47}