Skip to main content

qualia_vision/biosense/rppg/
pos_rppg_trace.rs

1//! POS (Plane-Orthogonal-to-Skin) style rPPG projection on RGB means over time.
2
3use crate::cv::error::CvError;
4
5/// `rgb_means` interleaved [r0,g0,b0, r1,g1,b1, ...] length 3*n_frames.
6/// Writes scalar pulse trace into `out` (n_frames).
7pub fn pos_rppg_trace(rgb_means: &[f32], n_frames: usize, out: &mut [f32]) -> Result<(), CvError> {
8    if n_frames == 0 || rgb_means.len() < n_frames * 3 || out.len() < n_frames {
9        return Err(CvError::BufferTooSmall);
10    }
11    // Temporal normalize per channel
12    let mut rs = 0.0f32;
13    let mut gs = 0.0f32;
14    let mut bs = 0.0f32;
15    for i in 0..n_frames {
16        rs += rgb_means[i * 3];
17        gs += rgb_means[i * 3 + 1];
18        bs += rgb_means[i * 3 + 2];
19    }
20    let n = n_frames as f32;
21    let rm = rs / n;
22    let gm = gs / n;
23    let bm = bs / n;
24    // POS: S1 = G-B, S2 = G+B-2R projected (simplified)
25    for i in 0..n_frames {
26        let r = rgb_means[i * 3] - rm;
27        let g = rgb_means[i * 3 + 1] - gm;
28        let b = rgb_means[i * 3 + 2] - bm;
29        let s1 = g - b;
30        let s2 = g + b - 2.0 * r;
31        // α ≈ std(s1)/std(s2) approx with running scale
32        out[i] = s1 - 0.5 * s2;
33    }
34    Ok(())
35}