pub fn se2_exp(tangent: &Vector3<f64>) -> Matrix3<f64>
Exponential map from se(2) to a homogeneous SE(2) matrix.