Closed leyuan-sun closed 2 years ago
I check the sophus
static SO3
This functions takes in an element of tangent space (= rotation vector omega) and returns the corresponding element of the group SO(3).
To be more specific, this function computes expmat(hat(omega)) with expmat(.) being the matrix exponential and hat(.) being the hat() -operator of SO(3).
So, I think the SO3.exp() in liegroups library includes the hat() already.
R_cur = SO3.exp(w_cur).as_matrix()
Does the w_cur need to be do hat() in advance, since the rotation in se3 should be done hat() then do the exp() when we convert se3 to rotation matrix?