刚体运动的分解:旋转+平移
旋转:旋转矩阵Rotation Matrix,是行列式为1的正交矩阵(逆为自身转置的矩阵),SO(n)表示特殊正交群
因此变化可表示为:A’ = RA+t
在三维向量末尾加1,变成4项之后,变成齐次的形式,SE(N),其中左上为旋转矩阵,右侧为平移矩阵,左下为0,右下为1,又称为特殊欧式群。
旋转矩阵的表示方法:旋转向量/欧拉角/四元数/
编程实现:Eigen库里的Vector3d、Matrix3d、Matrix<double,2,3>
几何模块:<Eigen/Gemetry>,AngleAxisd、Vector3d、Ismetry3d、 Quaterniond
可视化模块:Pangolin