文档介绍：机器人技术张秀丽北京交通大学机电学院*本章内容刚体位姿的描述刚体位姿的空间变换正交坐标变换齐次坐标变换重点坐标变换学习方法思路清晰运用空间想象理解数学原理第四章 机器人数学基础2刚体的几何表示: 用其上的一个基点和过基点的标线表示,如刚体E可用标线pq表示。刚体的运动: 刚体E由位置E1(p1,q1)运动到位置E(p,q),其运动过程可以看作绕p1点的转动和p1点的移动的合成。一、 刚体位姿描述3刚体的位姿: 将描述刚体的3个位置(移动自由度)和3个姿态(转动自由度)简称为刚体位姿。刚体位姿描述方法: (1)建立参考坐标系 (2)位置描述 (3)姿态描述 建立刚体坐标系, 用单位矢量n、o、a的方向余弦矩阵来描述。刚体的位姿yxzoybxbzbobonap一、 刚体位姿描述4坐标系首先选定一个参考坐标系Σ0,在手爪上固定另一个坐标系ΣB。B的z轴设在手指接近物体的方向,称为接近矢量;y轴设在两夹持手指的中央连线方向,称为方位矢量;x轴根据右手法则确定,称为法向矢量。由Σ0中的3个正交单位向量描述手爪姿态。手部坐标系ΣBn:normalo:orientation a:approach连杆n末端关节ny0x0z0O0Obo(yb) 方位矢量p基坐标系Σ0n(xb) 法向矢量a(zb) 接近矢量5方向余弦 矢量B的方向余弦定义为B方向的单位矢量在三个坐标轴上的投影,即:6方向余弦矩阵设坐标系Σ’(i’,j’,k’)与坐标系Σ(i,j,k)的原点重合,则x’、y’、z’轴在坐标系Σ中的方向余弦分别为:坐标系Σ’在Σ中的方向余弦矩阵为(以x’、y’、z’的方向余弦作为列向量):三个列向量元素的平方和为1;坐标系Σ’的三个坐标轴两两正交,点积为0。上述余弦方阵中共有9个方向余弦,存在6个约束条件,因此,坐标系Σ’只有3个自由度。在方向余弦阵中,只有不同行或不同列的三个元素是相互独立的。方向余弦矩阵性质又称此矩阵为旋转矩阵。n、o、a的方向余弦矩阵为(4)R矩阵正交性:由于n、o、a为单位矢量因此矩阵R是正交矩阵。y0z0o0xbybzbobnoapx0旋转矩阵特点:既可以作为姿态描述,又可以作为旋转算子,实现旋转运算。9用4×4的齐次矩阵来表示刚体位姿:称此矩阵为刚体位姿矩阵。或刚体位姿描述10