位姿表示   位置：如果在三维空间中，使用三个空间坐标表示： $$ \boldsymbol{x}_n = [x, y, z] $$   姿态：2D 姿态用一个旋转角$ \theta $表示。3D 姿态可用旋转矩阵...