pub fn se3_exp(tangent: &Vector6) -> Matrix4<f64>
Exponential map from se(3) to a homogeneous SE(3) matrix.