Function group_points_to_triangles

pub fn group_points_to_triangles(
    pixels_with_id: &Vec<(usize, Vector2<f32>)>,
    cam_points: &Matrix3xX<f32>,
) -> Vec<(Triangle<2>, Triangle<3>)>