se3_to_twist

Function se3_to_twist 

Source
pub fn se3_to_twist<T: Float>(se3: &M44<T>) -> V6<T>
Expand description

Convert a se3 matrix representation to a spatial velocity vector known as “twist”

Function arguments: se3: M44 a matrix in the se3 space

Output: V3: representing spatial velocity vector(“twist”)