f3l_core 0.3.0

3D Point Cloud Library
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45

use f3l_glam::{glam, F3lMatrix};

pub mod n_polynomial;
pub mod one_polynomial;

/// # Experimental
/// Solve `A` `X` = `B`
pub trait MatrixLinAlg: F3lMatrix
where
    Self: Copy,
{
    /// solve: ax = b
    fn solve(&self, b: Self::RowType) -> Self::RowType
    where
        <Self as F3lMatrix>::RowType: F3lMatrix,
    {
        n_polynomial::gaussian_elimination(self, &b)
    }
}

impl MatrixLinAlg for glam::Mat2 {}
impl MatrixLinAlg for glam::Mat3 {}
impl MatrixLinAlg for glam::Mat3A {}
impl MatrixLinAlg for glam::Mat4 {}

#[cfg(test)]
mod matrix_lin_alg_impl {
    use super::*;
    use crate::round_slice_n;
    use glam::{Mat3, Vec3};

    #[test]
    fn has_solution() {
        let a = Mat3::from_cols(
            Vec3::new(5., 3., 2.),
            Vec3::new(-6., -2., 4.),
            Vec3::new(-7., 5., -3.),
        );
        let b = Vec3::new(7., -17., 29.);

        let x: [f32; 3] = a.solve(b).into();

        assert_eq!(round_slice_n([2f32, 4f32, -3f32], 4), round_slice_n(x, 4));
    }
}