matrix_log6

Function matrix_log6 

Source
pub fn matrix_log6<T: Float + Sum + FloatConst>(t: &M44<T>) -> M44<T>
Expand description

Compute the matrix logarithm of a homogeneous transformation matrix

Function arguments: t: M44 a matrix in SE(3)

Ouput: M44 the matrix log of the input