Function matrix_exponential 

pub fn matrix_exponential<T: Float>(so3: &M33<T>) -> M33<T>

Compute the matrix exponential of a matrix in so(3)

Function arguments: so3: M33 a screw symetric matrix

Output: M33: representing the matrix exponential of the input