刚体位姿(即位置和姿态)，用刚体的方位矩阵和（ ）的原点位置矢量表示。