SE2
Se2, formally SE(2), is the Special Euclidean group in two dimensions. It describes all rigid motions of the plane, i.e., every combination of a plane rotation and a translation. An element can be written as a pair (R, t) with R ∈ SO(2) a rotation and t ∈ R^2 a translation. In homogeneous coordinates, SE(2) is represented by 3×3 matrices of the form
where R = [ [cos θ, −sin θ], [sin θ, cos θ] ] and t = [x, y]^T, with θ, x, y ∈ R. The group
Its Lie algebra, se(2), consists of 3×3 matrices of the form
where ω, v_x, v_y ∈ R. The corresponding twist coordinates are (v_x, v_y, ω). The exponential map exp: se(2)
t = [ (v_x sin θ + v_y (1 − cos θ)) / ω, (−v_x (1 − cos θ) + v_y sin θ) / ω ]^T.
If ω = 0, the transform reduces to a pure translation t = t_vec with R = I. SE(2) underpins