机器人学关于SE（3）、se（3）、SO（3）、so（3）的理解-Toy模板网

这篇具有很好参考价值的文章主要介绍了机器人学关于SE（3）、se（3）、SO（3）、so（3）的理解。希望对大家有所帮助。如果存在错误或未考虑完全的地方，请大家不吝赐教，您也可以点击"举报违法"按钮提交疑问。

李代数：李群单位元处的切空间；

在刚体运动中：

SO(3)代表旋转运动（ $R\in SO(3)$ ），齐次变换表示为: $\begin{matrix} R&0\\ 0&1\\ \end{matrix}$
T(3)代表平移运动，齐次变换表示为: $\begin{matrix} E&T\\ 0&1\\ \end{matrix}$
SE3代表刚体变换运动（旋转+平移），齐次变换表示为: $\begin{matrix} R&T\\ 0&1\\ \end{matrix}$
$\hat{\xi} \in se(3)$ 是SE(3)的李代数表达，物理上表示刚体的广义顺时速度,其中 $\hat{\xi}$ $\begin{matrix} \hat{\omega} &v\\ 0&1\\ \end{matrix}$

通过 $\hat{}$ 算子可以将4*4矩阵映射为六维向量 $\xi$ ，即： $\begin{matrix} \omega\\ v\\ \end{matrix}$
亦即运动旋量，其中 $\omega$ 为旋转角速度(瞬时转动)， $v$ 为平移速度（瞬时移动）。

李群和李代数的库是Sophus，支持SO(3),so(3),SE(3)和se(3)的定义和运算，继承于Eigen，所以可以使用Eigen定义的类和函数。

三维旋转群SO3：Sophus::SO3
刚体变换群SE3：Sophus::SE3
李代数so(3)：Sophus::Vector3d so3
李代数se(3)：Sophus::Vector6d se3

需要注意的是：

尽管SO3对应于矩阵群，但是SO3在使用cout时是以so3形式输出的，输出的是一个3维向量;
SE3在使用cout输出时输出的是一个6维向量，其中前3维为对应的so3的值，后3维为实际的平移向量T;
se3在使用cout输出时输出的也是一个6维向量，但是其前3维为平移值T（注意此时的T与SE3输出的t是不同的，t=JT,其中J是雅可比矩阵），后3维为其对应的so3.