点的位置用一个矢量表示: 坐标系B(相对于坐标系A)的姿态用一个矩阵表示: 每个矢量用投影分量表示: 每一行都是A单位矢量在B的表达: 正交阵的逆等于它的转置。 位姿描述:位置(一个位置矢量)和姿态(一个旋转矩阵)的组合描述。 已知位置矢量,