pub fn matrix_log6<T: Float + Sum + FloatConst>(t: &M44<T>) -> M44<T>
Compute the matrix logarithm of a homogeneous transformation matrix
Function arguments: t: M44 a matrix in SE(3)
t
Ouput: M44 the matrix log of the input
log