del-geo-core 0.1.38

2D/3D geometry utility codes
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

//! methods for NxN matrix in row major storage

pub fn try_inverse<Real, const N: usize, const NN: usize>(b: &[Real; NN]) -> Option<[Real; NN]>
where
    Real: num_traits::Float,
{
    let mut a = *b;
    for i in 0..N {
        if a[i * N + i].is_zero() {
            return None;
        }
        {
            let tmp1 = Real::one() / a[i * N + i];
            a[i * N + i] = Real::one();
            for k in 0..N {
                a[i * N + k] = a[i * N + k] * tmp1;
            }
        }
        for j in 0..N {
            if j == i {
                continue;
            }
            let tmp2 = a[j * N + i];
            a[j * N + i] = Real::zero();
            for k in 0..N {
                a[j * N + k] = a[j * N + k] - tmp2 * a[i * N + k];
            }
        }
    }
    Some(a)
}