del-geo 0.1.28

2D/3D geometry utility codes
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16

//! methods for 2x2 matrix
pub fn polar_decomposition<T>(
    m: &nalgebra::Matrix2<T>,
) -> (nalgebra::Matrix2<T>, nalgebra::Matrix2<T>)
where
    T: nalgebra::RealField + Copy,
{
    let x = m[(0, 0)] + m[(1, 1)];
    let y = m[(1, 0)] - m[(0, 1)];
    let scale = T::one() / (x * x + y * y).sqrt();
    let c = x * scale;
    let s = y * scale;
    let u_mat = nalgebra::Matrix2::<T>::new(c, -s, s, c);
    let p_mat = u_mat * m;
    (u_mat, p_mat)
}