Skip to main content

qualia_vision/biosense/pose/
pack_hand_landmarks.rs

1//! Pack MediaPipe Hand Landmarker 21 points (xy only).
2
3use crate::cv::error::CvError;
4
5pub const MAX_HAND_LANDMARKS: usize = 21;
6
7#[derive(Debug, Clone, Copy, Default, PartialEq)]
8pub struct HandLandmark {
9    pub x: f32,
10    pub y: f32,
11}
12
13/// Packs hand landmarks (xy).
14pub fn pack_hand_landmarks_xy(
15    xy: &[f32],
16    has_z: bool,
17    count: usize,
18    out: &mut [HandLandmark],
19) -> Result<usize, CvError> {
20    let n = count.min(MAX_HAND_LANDMARKS).min(out.len());
21    let stride = if has_z { 3 } else { 2 };
22    if xy.len() < n * stride {
23        return Err(CvError::BufferTooSmall);
24    }
25    for i in 0..n {
26        let base = i * stride;
27        out[i] = HandLandmark {
28            x: xy[base],
29            y: xy[base + 1],
30        };
31    }
32    Ok(n)
33}
34
35#[cfg(test)]
36mod tests {
37    use super::*;
38
39    #[test]
40    fn twenty_one_points() {
41        let xy = [0.1f32; 21 * 2];
42        let mut out = [HandLandmark::default(); MAX_HAND_LANDMARKS];
43        assert_eq!(
44            pack_hand_landmarks_xy(&xy, false, 21, &mut out).unwrap(),
45            21
46        );
47    }
48}