Function matrix_exponential6 

pub fn matrix_exponential6<T: Float>(se3: &M44<T>) -> M44<T>

Computes the matrix logarithm of a homogeneous transformation matrix

Function arguments: se3: M44 in SE(3)

Output: M44 The matrix logarithm of the input