qualia_vision/biosense/rppg/
pos_rppg_trace.rs1use crate::cv::error::CvError;
4
5pub 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 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 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 out[i] = s1 - 0.5 * s2;
33 }
34 Ok(())
35}