第三章 机器人运动

《第三章 机器人运动》由会员分享，可在线阅读，更多相关《第三章 机器人运动（60页珍藏版）》请在金锄头文库上搜索。

1、第三章 机器人运动学,第一节 概述 第二节 机器人的运动学基本问题 第三节 机器人的雅可比矩阵,第一节 概述,常见的机器人运动学问题可归纳如下： 1对一给定的机器人，已知杆件几何参数和关节角矢量求机器人末端执行器相对于参考坐标系的位置和姿态。 2已知机器人杆件的几何参数，给定机器人末端执行器相对于参考坐标系的期望位置和姿态 (位姿)，机器人能否使其末端执行器达到这个预期的位姿？如能达到，那么机器人有几种不同形态可满足同样的条件?,第一个问题常称为运动学正问题(直接问题); 第二个问题常称为运动学逆问题(解臂形问题)。这两个问题是机器人运动学中的基本问题。,第二节 机器人运动学的基本问题,一、运

2、动学基本问题 图31所示为2自由度机器人手部的连杆机构。,图中的连杆机构是两杆件通过转动副联接的关节结构，通过确定连杆长度，以及关节角，可以定义该连杆机构。在分析机器人的末端手爪的运动时，若把作业看作主要依靠机器人手爪来实现的，则应考虑手爪的位置（图中点的位置）。一般场合中，手爪姿势也表示手指位置。从几何学的观点来处理这个手指位置与关节变量的关系称为运动学（Kinematics）。,我们引入向量分别表示手爪位置和关节变量， 因此，利用上述两个向量来描述一下这个2自由度机器人的运动学问题。 手爪位置的各分量，按几何学可表示为：,(3-1),(3-2),用向量表示这个关系式，其一般可表示为 式中

3、表示向量函数。已知机器人的关节变量 ，求其手爪位置的运动学问题称为正运动学（direct kinematics）。该公式被称为运动方程式。如果，给定机器人的手爪位置，求为了到达这个预定的位置，机器人的关节变量的运动学问题称为逆运动学（inverse kinematics）。其运动方程式可以通过以下分析得到。,(3-3),如图所示，根据图中描述的几何学关系，可得,式中,(3-4),(3-5),(3-6),同样，如果用向量表示上述关系式，其一般可表示为,如图所示，机器人到达给定的手爪位置,有两个姿态满足要求，即图中的 也是其解。这时 和 变成为另外的值。即逆运动学的解不是惟一的，可以有多个解。,(

4、3-7),二、机器人位置与关节变量的关系,1表示方法 以手爪位置与关节变量之间的关系为例，要想正确表示机器人的手爪位置和姿态，就要首先建立坐标系，如图35所示，应分别定义固定机器人的基座和手爪的坐标系，这样才能很好地描述它们之间的位置和姿态之间的关系。,图33 基准坐标系和手爪坐标系,基准坐标系,固定在基座上,手爪坐标系 ，固定在手爪上,2姿态的变换矩阵 如图34所示，给出原点重合的两坐标系,则假设点 的位置 向量的分量在两坐标系中分别表示为,则从 向 的变换为：,其中：,它是从 坐标向坐标进行位置向 量姿态变换的矩阵，称为姿态变换矩阵（或旋转矩阵）。,为了加深印象，现在分析如图35所示坐标系

5、 ，它是将 围绕 轴沿正方向旋转角 后构成的坐标系。,图35 两个坐标系的旋转坐标变换,因此，在坐标系 上表示的坐标 与在将坐标系 绕 轴沿正方向旋转角 得到的坐标系 上表示的坐标 之间，存在下列关系式：,由上面知从 坐标系向坐标系 的坐标变换矩阵为：,因为上述变换是把某一坐标系上表示的坐标，表示到另一坐标系中，因此有时也称它为坐标变换。在该例子中是从 坐标系向坐标系 的坐标变换，由于坐标系 是 围绕 轴旋转 角后构成的坐标系，则该坐标变换矩阵也可用 来表示,同理，上述例子中，当考虑围绕着 轴旋转时（设其旋转量 为），可得到如下关系式：,另外，当围绕着轴 旋转时（设其旋转量 为），可表示为如下

6、关系式,可以验证,该矩阵为单位矩阵式中*表示 、 、 中的任何一个。所以有下列等式成立 在分析机器人运动时，当只用围绕一个轴旋转不能表示时，可以通过围绕几个轴同时旋转的组合方式进行表示。,均满足,3齐次变换,前面讨论了机器人在进行旋转运动时的坐标变换，一般来说，机器人的运动不仅是旋转运动，有时要做平行移动，或以上两种运动的合成，因此也应考虑平移运动时的坐标变换，即齐次变换。,现在来看下图的两个坐标系，坐标系 是将坐标系 单独地平行移动 后，再进行适当地旋转得到的坐标系。,这时，某一点 其在坐标系 和 上的坐标分别为 、 ，可以认为， 是由 旋转而进行坐标变换后，即乘以旋转坐标变换 ，在加上表示

7、平移的向量 而得到的，因此可写出下列表达式：,因旋转而进行的坐标变换，与因平移而进行的坐标变换，可以用一个坐标变换矩阵来表示，记为 ，称这个矩阵 为齐次坐标变换矩阵，或简称为坐标变换矩阵，表示为：,三、机器人的运动学的一般表示,前面所介绍的是任意两个坐标系之间的坐标变换，我们知道，机器人一般是有多个关节组成的，各关节之间的坐标变换可以通过坐标变换相乘后，结合在一起进行求解。如前所述，可以把机器人的运动模型看作是一系列由关节连接起来的连杆机构。一般机器人具有个自由度，为了分析其运动，可将上述方法扩展一下。,通常把描述一个连杆与下一个连杆间相对关系的齐次变换称为 矩阵。一个 矩阵就是一个描述连杆坐

8、标系间相对平移和旋转的齐次变换。如果用 表示第一个连杆在基系的位置和姿态， 表示第二个连杆相对第一个连杆的位置和姿态，那么第二个连杆在基系的位置和姿态可由下列矩阵的乘积求得,同理，若 表示第三个连杆相对第二个连杆的位置和姿态，那么第三个连杆在基系的位置和姿态可由下列矩阵的乘积求得,于是，对于六连杆的机器人，有下列矩阵 成立 一般，每个连杆有一个自由度，则六连杆组成的机器人具有六个自由度，并能在其运动范围内任意定位与定向。其中，三个自由度用于规定位置，另外三个自由度用来规定姿态。所以，表示了机器人的位置和姿态。,对于具有 个关节的机器人，若设坐标系 为固定在指尖上的坐标系时，则从坐标系 到基准坐

9、标系 的坐标变换矩阵 可由下式给出： 不仅是从 坐标系到坐标系 的坐标变换，而且同时还可以解释为在基准坐标系 上看到的表示指尖位置和方向的矩阵。,四、机器人运动问题的示例,1机器人正运动学问题 机器人正运动学问题就是求机器人运动学的正解（forward kinematics），即在给定组成运动副的相邻连杆的相对位置情况下，确定机器人末端执行器的位置和姿态。通过上述分析可知，运动学正解可用一个反映此相对关系的变换矩阵来表示，这里一般是指开式链的机器人结构。,以一个6自由度的机器人为例，如图所示，在该机器人中，除第3个关节为平移关节外，其余均为旋转关节。,对于这个机器人，根据图中表示的坐标系 为基

10、准坐标系，正运动学问题就是求该机器人末端手指关节6的位置和姿态，也就是在基准坐标系上看关节6，因此找出由 到 的坐标 变换矩阵 即可。也就是表示这个机器人的末端指尖的位置和方向，可以由下式给出：,其中,上式即为该6自由度机器人的运动学正解。对于不同类型的机器人，其坐标变换矩阵的形式不同，要根据实际结构求得。,2机器人逆运动学,机器人的逆解问题比较复杂，为了说明问题，下面先以2自由度的机器人为例。 如图所示，已知机器人末端的坐标值（x,y） ，试利用 表示,根据图中的几何关系可知：,（338）,（339）,联立求解上述两方程，可分别求出 的表达式。,因此可进一步得到：,将该式代入前面的几何表达式

11、就可求出的 表达式。,从机器人的手爪末端位置姿态出发，可以求出机器人对应的各关节的角度。该例的机器人是属于平面多关节机器人，对于一般的机械手来讲，其求解过程比较复杂，往往其解不是唯一的。请有兴趣的读者参考相关的文献书籍。,第三节 机器人的雅可比矩阵,一、雅可比矩阵的定义 前面讨论了机器人的指尖位置和方向与各关节的变化位置之间的关系。在本节将进一步讨论指尖的速度与各关节的速度（转动或平移）之间的关系。 考虑机械手的手爪位置 和关节变量 的关系用正运动学方程表示如下：,假定这里考虑的是,的一般情况，并设手爪位置包含表示姿态的变量，以及关节变量由回转角和平移组合而成的情况。,（355）,若用每个分量

12、表示，则变为 在 的情况下，将变为手爪位置的关节变量有无限个解的冗余机器人。而工业上常用的多关节机器人手臂，通常用于作业的所需手爪应有3个位置变量和3个姿态变量，总计6个变量。而且由于不采用冗余机器人结构，所以 。,将式（355）的两边对时间微分，可得到下式,（357）,其中,（358）,称 为雅可比矩阵（Jacobian matrix）。若在式（357）的两边乘以微小时间 ，则可得到,（359）,该式是用雅可比矩阵表示微小位移间关系的关系式。,二、与平移速度相关的雅可比矩阵,现在设基准坐标系为 ，固定于指尖的坐标系为 ，在 上表示的的坐标为 ，则 可以表示如下：,（360）,这时，指尖的平移

13、速度可以写成：,（361）,式中， ，其中 是关节的数目。这里的 称为与平移速度相关的雅可比矩阵。,下面以2自由度机械手为例，如前面图32所示的2自由度机械手的雅可比矩阵。前面已推导过，该机器人的指尖位置可以表示为,则与这个机器人的平移速度相关的雅可比矩阵，可以下列形式给出：,（363）,现在，我们来讨论一下 的各列向量的几何学意义，即在 时，考虑 ， 的几何学意义。根据式（363）， 是在时 ，也就是第2关节固定时，仅在第1关节转动的情况下，指尖平移速度在基准坐标系上表示出的向量。 同样， 是第1关节固定时，仅在第2关节转动的情况下，指尖平移速度在基准坐标系上表示出的向量。,因此，当用图表示

14、 和 时，就变成了如图所示的情况。,图39 和 的几何学说明,三、与旋转速度相关的雅可比矩阵,一般来讲，指尖的旋转速度表示方法，有以下两种类型：,1考虑由表示指尖方向的三变量组合（例如为欧拉角）构成向量 ，然后由它对时间的微分 进行表示的一种方法。 2以基准坐标系的各坐标轴作为旋转轴，以分别围绕各旋转轴的角速度作为分量构成向量 ，然后用 进行表示的方法。,在第二种表示方法中，可以把 解释为在基准坐标系上，围绕 轴， 轴和 轴的旋转速度的合成，因为物理意义明确。这时，公式,（364）,其中矩阵 称为与旋转速度相关的雅可比矩阵。,四、雅可比矩阵的计算方法,考虑一般情况，如六维向量，它可以指尖的平移速度和旋转速度作为其向量的分量，即,（365）,这时，若采用 和 表示机器人的雅可比矩阵，则表示,（366）,这里，为了计算雅可比矩阵中的各分量，需对进一步作下列分割,式中， 为机器人的关节数， 和 分别表示 和 的第个列向量。而 和 则分别表示只有第 个关节以速度 运行，其他的关节都固定时的指尖平移速度向量和旋转速度向量。,（367）,这时， 和 可以求解如下： 第 个关节为平移关节时 第 个关节为旋转关节时,（3