pub fn se3_to_twist<T: Float>(se3: &M44<T>) -> V6<T>
Convert a se3 matrix representation to a spatial velocity vector known as “twist”
Function arguments: se3: M44 a matrix in the se3 space
se3
Output: V3: representing spatial velocity vector(“twist”)