qualia_vision/biosense/rppg/
chrom_rppg_trace.rs1use crate::cv::error::CvError;
4
5pub 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}