qualia_vision/biosense/pose/
pack_hand_landmarks.rs1use 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
13pub 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}