机器人学的数学基础.docVIP

第3章 机器人学的数学基础 在机器人操作手工作时，我们需要在其特定三维工作空间中掌握各个物体之间的几何关系，这些物体包括操作手组成自身的各个活动杆件、底座、末端执行器、抓持工具、待抓取物体、障碍物等，它们之间的三维空间几何关系可用两个非常重要的特性来描述： 位置和姿态。 3.1 位置和姿态表示 为了精确描述各个连杆或物体之间的位置和姿态关系，我们首先定义一个固定的坐标系，并以它作为参考坐标系，所有静止或运动的物体就可以统一在同一个参考坐标系中进行比较。该坐标系统通常被称为世界坐标系。 基于此共同的坐标系描述机器人自身及其周围物体，是机器人在三维空间中工作的基础。通常，我们对每个物体或连杆都定义一个本体坐标系，又称局部坐标系，每个物体与附着在该物体上本体坐标系是相对静止的,即其相对位置和姿态是固定的。 因此，每个物体之间位置和姿态的关系就可以用它们自身的本体坐标系之间的位姿关系来确定了，本体坐标系原点之间的关系代表了它们的位置关系，本体坐标系各个坐标轴方向之间的关系代表了方位关系。图3-1表示了机器人手臂及其周围物体在世界坐标系中及各自本体坐标系中的位置和姿态。 z y x z x zzzzzz x y y x p z z y \ 图 3-1 机器人手臂及其周围物体的位置和姿态 3.1.1 位置描述 建立坐标系之后，三维空间中的任何一点都可以用一个具有三个分量的位置矢量来进行定位。例如， 图3-1中立方体的质心p在世界坐标系中的表示是： 下标w代表了世界坐标系，因为位置矢量 在不同坐标系中数值表示不同。以上就是典型的基于笛卡尔坐标系的三维空间位置矢量的描述方法。当采用不同的坐标系表示时，会有不同的位置描述方法。例如 基于圆柱坐标系的空间矢量表示方法，基于球坐标系的空间矢量表示方法等。 3.1.2 方位描述 机器人手臂工作时，不但要考虑所抓取的物体的质心的位置，还要考虑空间中该物体的姿态，既方位。空间中的物体，不但要考虑它的位置，还要考虑它的方位。空间物体通常用自身本体坐标系的坐标原点表示位置，坐标轴的方向代表方位。物体的相对位置和方位通常用它们各自的本体坐标系之间的关系来表示。相对位置关系用局部坐标系的坐标原点之间的关系表示，方位关系用各自本体坐标系的坐标轴单位方向矢量之间的关系来表示。常用的方位描述包括旋转矩阵表示法，固定角表示法，欧拉角表示法，等效轴角表示法，欧拉参数表示法等。我们主要介绍旋转矩阵方位描述法，并简介固定角表示法，其它方法参考教科书。 旋转矩阵描述法 一个本体坐标系{B}相对于另一个参考坐标系{A}的姿态描述，用这个本体坐标