pub fn hat_se3(xi: &Vector6<f64>) -> Matrix4<f64>
The embedding of se(3) into 4×4 matrices: ξ^ = [[φ^, ρ], [0, 0]].
se(3)
ξ^ = [[φ^, ρ], [0, 0]]