机器人学导论第五章解读课件

机器人学导论第五章静力和速度——新疆大学机械工程学院机器人学导论第五章静力和速度——新疆大学1第五章速度和静力概述在本章中，我们将机器人操作臂的讨论扩展到静态位置问题以外。我们研究刚体线速度和角速度的表示方法并且运用这些概念去分析操作臂的运动。我们将讨论作用在刚体上的力，然后应用这些概念去研究操作臂静力学应用的问题。关于速度和静力的研究将得出一个称为操作臂雅克比的实矩阵。第五章速度和静力概述2矢量的导数（5-1）位置矢量的速度可以看成是用位置矢量描述的空间一点的线速度。式5-1可以看出，可以通过计算Q相对于坐标系{B}的微分进行描述。左上标B是表明相对于坐标系{B}进行的微分矢量的导数3像其他矢量一样速度矢量能在任意坐标系中描述，器参考坐标系用左上标注明，如果在坐标系{A}中表示式（5-1）的速度矢量，可以写为给出速度表达式像其他矢量一样速度矢量能在任意坐标系中描述，器参考坐标系用左4经常讨论的是一个坐标系元旦相对于某个常见的世界参考坐标系的速度，而不考虑任意坐标系中一般点的速度。对于这种情况定义一个缩写符号那么是坐标系{C}的原点在坐标系A中表示的速度，尽管微分是相对于坐标系{U}进行的经常讨论的是一个坐标系元旦相对于某个常见的世界参考坐标系的速5角速度矢量角速度矢量用符号表示。线速度描述了点的一种属性，角速度描述了刚体的一种属性。坐标系总是固连在刚体上，所以可以用角速度描述坐标系的旋转运动。图5-2在图5-2中，描述了坐标系{B}相对于坐标系{A}的旋转。实际上的方向就是{B}相对于{A}的瞬时旋转轴，的大小表示旋转速度。角速度矢量同样可以在任意坐标中描述，例如，就是坐标系{B}相对于{A}的角速度在坐标系{C}中的描述。角速度矢量角速度矢量用符号表示。线速度描述了点的一种6在参考坐标系非常简单可用一种简化的表示方法这里，为坐标系{C}相对于某个已知坐标系{U}的角速度。例如就是坐标系{C}的角速度在坐标系{A}中的描述，尽管这个角速度是相对于坐标系{U}的。在参考坐标系非常简单可用一种简化的表示方法75.3刚体的线速度和角速度线速度把坐标系固连在一刚体上，要求描述相对于坐标系{A}的运动,如图5-3所示。这里已经认为坐标系{A}是固定的。此时我们假定不随时间变化。则Q点相对于坐标系{A}的运动是由于或随时间的变化引起的。

5.3刚体的线速度和角速度线速度8角速度我们讨论两坐标系的原点重合，相对线速度为0的情况。(1)时（5-10）(2)时（5-11）角速度9线速度和角速度同时存在的情况（5-13）这是把原点的线速度加到式（5-12）中，得到了从坐标系{A}观测坐标系{B}的普遍公式。线速度和角速度同时存在的情况105.4对角速度的进一步研究前一节用几何方法证明了式(5-10)的有效性，这里将引入数学方法正交矩阵导数的性质我们可以推出正交矩阵和某一反对称矩阵的一种特殊关系。对于任何n×n正交矩阵R，有（5-14）当n=3，R为特征正交矩阵R，即旋转矩阵，对式（5-14）求导得5.4对角速度的进一步研究前一节用几何方法证明了式(5-111定义S为反对称矩阵，因此正交矩阵的微分与反对称矩阵之间存在如下特性，可以写为定义12由于参考系旋转的点速度假定固定矢量相对于坐标系{B}是不变的，在另一个坐标系{A}中的描述为由于坐标系{B}的旋转，代入表达式，得将代入有(5-24)由于参考系旋转的点速度假定固定矢量相对于坐标系{B13反对称阵和矢量积如果反对称阵S的各元素如下：(5-25)定义3×1的列矢量(5-26)容易证明(5-27)反对称阵和矢量积如果反对称阵S的各元素如下：14与式（5-24）联立可得与式（5-24）联立可得155.5机器人连杆的运动连杆间的速度传递操作臂是一个链式结构，每一个连杆的运动都与它的相邻连杆有关。连杆i+1的速度就是连杆i的速度加上那些附加到关节i+1上的新的速度分量。5.5机器人连杆的运动连杆间的速度传递16如图5-6所示，连杆i+1的角速度就等于连杆i的角速度加上一个由于关节i+1的角速度引起的分量。参照坐标系{i}，上述关系可写成图5-6其中如图5-6所示，连杆i+1的角速度就等于连杆i的角速度加上一17在方程式5-43两边同时左乘可以得到连杆i+1的角速度相对于坐标系{i+1}的表达式：在方程式5-43两边同时左乘可以得到连杆i+1的18坐标系{i+1}原点的线速度等于坐标系{i}原点的线速度加上一个由于连杆i的角速度一起的新的分量。由于在坐标系{i}中是常数，所以有，（5-46）两边同时左乘得（5-47）从一个连杆到下一个连杆依次应用这些公式，可以计算出最后一个连杆的角速度和线速度，注意，这两个公式是按照坐标系{N}表达的，如果用基坐标系来表达角速度和线速度的话，就可以用去左乘速度，向基坐标系进行旋转变换。坐标系{i+1}原点的线速度等于坐标系{i}原点的线速度加上19例5.3图5-8所示是具有两个转动关节的操作臂.计算出操作臂末端的速度，将它表达成操作臂末端的函数。给出两种形式的解答，一种是用坐标系{3}表示，一种是用坐标系{0}表示。图5-8两连杆操作臂图5-9两连杆操作臂的坐标系布局例5.3图5-8所示是具有两个转动关节的操作臂.计算出20首先将坐标系固连在连杆上，计算连杆变换如下首先将坐标系固连在连杆上，计算连杆变换如下21运用式（5-45）和式（5-47）从基坐标{0}依次计算出每个坐标系原点的速度，其中基坐标系的速度为0。（5-55）（5-54）（5-53）（5-52）（5-51）（5-50）运用式（5-45）和式（5-47）从基坐标{0}依次计算出每22式（5-55）即为答案。为了得到这些速度相对于基坐标的表达，用旋转矩阵对它们作旋转变换，即（5-56）通过这个变换可以得到（5-57）式（5-55）即为答案。为了得到这些速度相对于基坐标的表达，235.7雅克比雅克比矩阵是多元形式的导数。例如假设有6个函数，每个函数有6个独立变量：5.7雅克比雅克比矩阵是多元形式的导数。例如假设有6个函数24由多元函数求导法则得在任一瞬时，x都有一个确定的值，J(X)是一个线性变换。在每个新时刻，如果X改变，线性变换也随之而变。所以雅克比是时变的线性变换。由多元函数求导法则得在任一瞬时，x都有一个确定的值，J(X)25在机器人学中，通常使用雅克比将关节速度与操作臂末端的笛卡尔速度联系起来，比如(5-64)式中θ是操作臂关节角矢量，v是笛卡尔速度矢量。在式中我们给雅克比表达式附加了左上标，以此来表示笛卡尔速度所参考的坐标系。对于通常的6关节机器人，雅克比矩阵是6×6阶矩阵，是6×1维的，也是6×1维的。这个6×1笛卡尔速度矢量是由一个3×1的线速度矢量和一个3×1的角速度矢量组合起来的：(5-65)在机器人学中，通常使用雅克比将关节速度与操作臂末端的笛卡尔速26写出例5.3中的雅克比矩阵由例5.3的结果式（5-55）可写出坐标系{3}的雅克比表达式式（5-57）可写出坐标系{0}的雅克比表达式（5-66）（5-67）写出例5.3中的雅克比矩阵（5-66）（5-67）27雅克比矩阵参考坐标系的变换已知坐标系{B}中的雅克比矩阵，即我们关心的是给出雅克比矩阵在另一个坐标系{A}中的表达式。由于因此可以得到雅克比矩阵参考坐标系的变换已知坐标系{B}中的雅克比矩阵，即28显然利用下列关系可以完成雅克比矩阵参考坐标系的变换：显然利用下列关系可以完成雅克比矩阵参考坐标系的变换：295.9作用在操作臂上的静力操作臂的链式结构自然让我们想到力和力矩是如何从一个连杆向下一个连杆传递的。我们要做的是求出保持系统静态平衡的关节扭矩。我们为相邻杆件所施加的力和力矩定义一下特殊符号：=连杆i-1施加在连杆i上的力=连杆i-1施加在连杆i上的力矩。5.9作用在操作臂上的静力操作臂的链式结构自然让我们想到30建立连杆坐标系，图5-11为施加在连杆i上的静力和静力矩（重力除外）。将这些力相加并令其和为0，有图5-11单连杆的静力和静力矩的平衡关系建立连杆坐标系，图5-11为施加在连杆i上的静力和静力矩（重31将绕坐标系{i}原点的力矩相加，有如果我们从施加于手部的力和力矩的描述开始，从末端连杆到基座进行计算就可以计算出作用于每一个连杆上的力和力矩。将以上两式重新整理，以便从高序号连杆向低序号连杆进行迭代求解。结果如下用旋转矩阵进行变换得到最重要的连杆之间的静力“传递”表达式：将绕坐标系{i}原点的力矩相加，有如果我们从施加于手部的力和32除了绕关节轴的力矩外，力和力矩矢量的所有分量都可由操作臂机构本身来平衡。因此，为了求出系统静平衡所需的关节力矩，应计算关节轴矢量和施加在连杆上的力矩矢量的点积：对于关节是移动关节的情况，可以计算出关节驱动力为式（5-80）到式（5-83）给出一种方法，可以计算静态作用下操作臂末端执行器施加力和力矩所需的关节力。除了绕关节轴的力矩外，力和力矩矢量的所有分量都可由操作臂机构33例5.7在例5.3的两连杆操作臂，在末端执行器施加作用力矢量（可以认为该力是作用在坐标系{3}的原点上）。按照位形和作用力的函数给出所需的关节力（见图5-12）。图5-12应用式（5-80）到式（5-82），从末端连杆开始向机器人的基座计算：例5.7图5-12应用式（5-80）到式（5-82），从末端34于是有可将这个关系写成矩阵算子：于是有可将这个关系写成矩阵算子：355.10力域中的雅可比功具有能量的单位，所以它在任何广义坐标系下的测量值都相同。特别是在笛卡尔空间做的功应当等于关节空作的功式中F是一个作用在末端执行器上的6×1维笛卡尔力-力矩质量，δχ是一个作用在末端执行器的6×1维无穷小笛卡尔位移矢量，τ是6×1维关节力矩矢量，δθ是6×1维无穷小的关节位移矢量。式(5-91)也可写成5.10力域中的雅可比功具有能量的单位，所以它在任何广义36雅克比矩阵的定义为因此可以写出对所有的δθ，上式均成立，因此有对上式两边转置，可得式5-96从一般意义上证明了里5.6中两连杆操作臂的特殊情况：雅克比的转置将作用在手臂上的笛卡尔力映射成了等效雅克比矩阵的定义为因此可以写出对所有的δθ，上式均成立，因此37关节力矩。当得到相对于坐标系{0}的雅克比矩阵后，可以由下式对坐标系{0}中的力矢量进行变换：注意，式（5-97）是一个非常有趣的关系式，它可将一个笛卡尔空间的两变换为一个关节空间的两而无需计算任何运动学函数的逆解。关节力矩。当得到相对于坐标系{0}的雅克比矩阵后，可以由下式38速度和静力的笛卡尔变换根据6×1维的刚体广义速度表达式进行讨论：同样，考虑6×1维的广义力矢量表达式，即很自然的想到将这些量从一个坐标系映射到另一个坐标系。速度和静力的笛卡尔变换根据6×1维的刚体广义速度表达式进行讨39这里，用矩阵算子的形式写出式（5-45）和式（5-47），将坐标系{A}中的广义速度矢量变换为在坐标系{B}中的描述。这里涉及的两个坐标系之间的连接是刚性的，所以在式(5-45)中出现的被置零式中叉乘又可看成是矩阵算子这里，用矩阵算子的形式写出式（5-45）和式（5-47），将40现在式（5-100）将一个坐标系的速度与两一个坐标系的速度联系起来，这个6×6算子被称为速度变换矩阵，用符号表示，因此可将是（5-100）表示成紧凑的形式：已知{B}中的速度值，为了计算在{A}中的速度描述，可以对是（5-100）求逆：即现在式（5-100）将一个坐标系的速度与两一个坐标系的速度联41同样，由式（5-80）和（5-81）可得6×6的矩阵，它可将在坐标系{B}中的广义力矢量变换成在坐标系{A}中的描述，即为可以写成紧凑形式式中用来表示一个力—力矩变换速度和力变换矩阵与雅克比矩阵相似，可把不同坐标系中的速度和力联系起来。参照雅克比矩阵，有同样，由式（5-80）和（5-81）可得6×6的矩阵，它可将42机器人学导论第五章静力和速度——新疆大学机械工程学院机器人学导论第五章静力和速度——新疆大学43第五章速度和静力概述在本章中，我们将机器人操作臂的讨论扩展到静态位置问题以外。我们研究刚体线速度和角速度的表示方法并且运用这些概念去分析操作臂的运动。我们将讨论作用在刚体上的力，然后应用这些概念去研究操作臂静力学应用的问题。关于速度和静力的研究将得出一个称为操作臂雅克比的实矩阵。第五章速度和静力概述44矢量的导数（5-1）位置矢量的速度可以看成是用位置矢量描述的空间一点的线速度。式5-1可以看出，可以通过计算Q相对于坐标系{B}的微分进行描述。左上标B是表明相对于坐标系{B}进行的微分矢量的导数45像其他矢量一样速度矢量能在任意坐标系中描述，器参考坐标系用左上标注明，如果在坐标系{A}中表示式（5-1）的速度矢量，可以写为给出速度表达式像其他矢量一样速度矢量能在任意坐标系中描述，器参考坐标系用左46经常讨论的是一个坐标系元旦相对于某个常见的世界参考坐标系的速度，而不考虑任意坐标系中一般点的速度。对于这种情况定义一个缩写符号那么是坐标系{C}的原点在坐标系A中表示的速度，尽管微分是相对于坐标系{U}进行的经常讨论的是一个坐标系元旦相对于某个常见的世界参考坐标系的速47角速度矢量角速度矢量用符号表示。线速度描述了点的一种属性，角速度描述了刚体的一种属性。坐标系总是固连在刚体上，所以可以用角速度描述坐标系的旋转运动。图5-2在图5-2中，描述了坐标系{B}相对于坐标系{A}的旋转。实际上的方向就是{B}相对于{A}的瞬时旋转轴，的大小表示旋转速度。角速度矢量同样可以在任意坐标中描述，例如，就是坐标系{B}相对于{A}的角速度在坐标系{C}中的描述。角速度矢量角速度矢量用符号表示。线速度描述了点的一种48在参考坐标系非常简单可用一种简化的表示方法这里，为坐标系{C}相对于某个已知坐标系{U}的角速度。例如就是坐标系{C}的角速度在坐标系{A}中的描述，尽管这个角速度是相对于坐标系{U}的。在参考坐标系非常简单可用一种简化的表示方法495.3刚体的线速度和角速度线速度把坐标系固连在一刚体上，要求描述相对于坐标系{A}的运动,如图5-3所示。这里已经认为坐标系{A}是固定的。此时我们假定不随时间变化。则Q点相对于坐标系{A}的运动是由于或随时间的变化引起的。

5.3刚体的线速度和角速度线速度50角速度我们讨论两坐标系的原点重合，相对线速度为0的情况。(1)时（5-10）(2)时（5-11）角速度51线速度和角速度同时存在的情况（5-13）这是把原点的线速度加到式（5-12）中，得到了从坐标系{A}观测坐标系{B}的普遍公式。线速度和角速度同时存在的情况525.4对角速度的进一步研究前一节用几何方法证明了式(5-10)的有效性，这里将引入数学方法正交矩阵导数的性质我们可以推出正交矩阵和某一反对称矩阵的一种特殊关系。对于任何n×n正交矩阵R，有（5-14）当n=3，R为特征正交矩阵R，即旋转矩阵，对式（5-14）求导得5.4对角速度的进一步研究前一节用几何方法证明了式(5-153定义S为反对称矩阵，因此正交矩阵的微分与反对称矩阵之间存在如下特性，可以写为定义54由于参考系旋转的点速度假定固定矢量相对于坐标系{B}是不变的，在另一个坐标系{A}中的描述为由于坐标系{B}的旋转，代入表达式，得将代入有(5-24)由于参考系旋转的点速度假定固定矢量相对于坐标系{B55反对称阵和矢量积如果反对称阵S的各元素如下：(5-25)定义3×1的列矢量(5-26)容易证明(5-27)反对称阵和矢量积如果反对称阵S的各元素如下：56与式（5-24）联立可得与式（5-24）联立可得575.5机器人连杆的运动连杆间的速度传递操作臂是一个链式结构，每一个连杆的运动都与它的相邻连杆有关。连杆i+1的速度就是连杆i的速度加上那些附加到关节i+1上的新的速度分量。5.5机器人连杆的运动连杆间的速度传递58如图5-6所示，连杆i+1的角速度就等于连杆i的角速度加上一个由于关节i+1的角速度引起的分量。参照坐标系{i}，上述关系可写成图5-6其中如图5-6所示，连杆i+1的角速度就等于连杆i的角速度加上一59在方程式5-43两边同时左乘可以得到连杆i+1的角速度相对于坐标系{i+1}的表达式：在方程式5-43两边同时左乘可以得到连杆i+1的60坐标系{i+1}原点的线速度等于坐标系{i}原点的线速度加上一个由于连杆i的角速度一起的新的分量。由于在坐标系{i}中是常数，所以有，（5-46）两边同时左乘得（5-47）从一个连杆到下一个连杆依次应用这些公式，可以计算出最后一个连杆的角速度和线速度，注意，这两个公式是按照坐标系{N}表达的，如果用基坐标系来表达角速度和线速度的话，就可以用去左乘速度，向基坐标系进行旋转变换。坐标系{i+1}原点的线速度等于坐标系{i}原点的线速度加上61例5.3图5-8所示是具有两个转动关节的操作臂.计算出操作臂末端的速度，将它表达成操作臂末端的函数。给出两种形式的解答，一种是用坐标系{3}表示，一种是用坐标系{0}表示。图5-8两连杆操作臂图5-9两连杆操作臂的坐标系布局例5.3图5-8所示是具有两个转动关节的操作臂.计算出62首先将坐标系固连在连杆上，计算连杆变换如下首先将坐标系固连在连杆上，计算连杆变换如下63运用式（5-45）和式（5-47）从基坐标{0}依次计算出每个坐标系原点的速度，其中基坐标系的速度为0。（5-55）（5-54）（5-53）（5-52）（5-51）（5-50）运用式（5-45）和式（5-47）从基坐标{0}依次计算出每64式（5-55）即为答案。为了得到这些速度相对于基坐标的表达，用旋转矩阵对它们作旋转变换，即（5-56）通过这个变换可以得到（5-57）式（5-55）即为答案。为了得到这些速度相对于基坐标的表达，655.7雅克比雅克比矩阵是多元形式的导数。例如假设有6个函数，每个函数有6个独立变量：5.7雅克比雅克比矩阵是多元形式的导数。例如假设有6个函数66由多元函数求导法则得在任一瞬时，x都有一个确定的值，J(X)是一个线性变换。在每个新时刻，如果X改变，线性变换也随之而变。所以雅克比是时变的线性变换。由多元函数求导法则得在任一瞬时，x都有一个确定的值，J(X)67在机器人学中，通常使用雅克比将关节速度与操作臂末端的笛卡尔速度联系起来，比如(5-64)式中θ是操作臂关节角矢量，v是笛卡尔速度矢量。在式中我们给雅克比表达式附加了左上标，以此来表示笛卡尔速度所参考的坐标系。对于通常的6关节机器人，雅克比矩阵是6×6阶矩阵，是6×1维的，也是6×1维的。这个6×1笛卡尔速度矢量是由一个3×1的线速度矢量和一个3×1的角速度矢量组合起来的：(5-65)在机器人学中，通常使用雅克比将关节速度与操作臂末端的笛卡尔速68写出例5.3中的雅克比矩阵由例5.3的结果式（5-55）可写出坐标系{3}的雅克比表达式式（5-57）可写出坐标系{0}的雅克比表达式（5-66）（5-67）写出例5.3中的雅克比矩阵（5-66）（5-67）69雅克比矩阵参考坐标系的变换已知坐标系{B}中的雅克比矩阵，即我们关心的是给出雅克比矩阵在另一个坐标系{A}中的表达式。由于因此可以得到雅克比矩阵参考坐标系的变换已知坐标系{B}中的雅克比矩阵，即70显然利用下列关系可以完成雅克比矩阵参考坐标系的变换：显然利用下列关系可以完成雅克比矩阵参考坐标系的变换：715.9作用在操作臂上的静力操作臂的链式结构自然让我们想到力和力矩是如何从一个连杆向下一个连杆传递的。我们要做的是求出保持系统静态平衡的关节扭矩。我们为相邻杆件所施加的力和力矩定义一下特殊符号：=连杆i-1施加在连杆i上的力=连杆i-1施加在连杆i上的力矩。5.9作用在操作臂上的静力操作臂的链式结构自然让我们想到72建立连杆坐标系，图5-11为施加在连杆i上的静力和静力矩（重力除外）。将这些力相加并令其和为0，有图5-11单连杆的静力和静力矩的平衡关系建立连杆坐标系，图5-11为施加在连杆i上的静力和静力矩（重73将绕坐标系{i}原点的力矩相加，有如果我们从施加于手部的力和力矩的描述开始，从末端连杆到基座进行计算就可以计算出作用于每一个连杆上的力和力矩。将以上两式重新整理，以便从高序号连杆向低序号连杆进行迭代求解。结果如下用旋转矩阵进行变换得到最重要的连杆之间的静力“传递”表达式：将绕坐标系{i}原点的力矩相加，有如果我们从施加于手部的力和74除了绕关节轴的力矩外，力和力矩矢量的所有分量都可由操作臂机构本身来平衡。因此，为了求出系统静平衡所需的关节力矩，应计算关节轴矢量和施加在连杆上的力矩矢量的点积：对于关节是移动关节的情况，可以计算出关节驱动力为式（5-80）到式（5-83）给出一种方法，可以计算静态作用下操作臂末端执行器施加力和力矩所需的关节力。除了绕关节轴的力矩外，力和力矩矢量的所有分量都可由操作臂机构75例5.7在例5.3的两连杆操作臂，在末端执行器施加作用力矢量（可以认为该力是作用在坐标系{3}的原点上）。按照位形和作用力的函数给出所需的关节力（见图5-12）。图5-12应用式（5-80）到式（5-82），从末端连杆开始向机器人的基座