机器人技术 第六章课件

机器人技术2005.2.机器人技术第六章

第六章机器人静力学和动力学

静力学和动力学分析，是机器人操作机设计和动态性能分析的基础。特别是动力学分析，它还是机器人控制器设计、动态仿真的基础。机器人静力学研究机器人静止或缓慢运动式，作用在机器人上的力和力矩问题。特别是当手端与环境接触时，各关节力（矩）与接触力的关系。

机器人动力学研究机器人运动与关节驱动力（矩）间的动态关系。描述这种动态关系的微分方程称为动力学模型。由于机器人结构的复杂性，其动力学模型也常常很复杂，因此很难实现基于机器人动力学模型的实时控制。然而高质量的控制应当基于被控对象的动态特性，因此，如何合理简化机器人动力学模型，使其适合于实时控制的要求，一直是机器人动力学研究者追求的目标。2机器人技术第六章6.1机器人静力学

一、杆件之间的静力传递

在操作机中，任取两连杆，。设在杆上的点作用有力矩和力；在杆上作用有自重力〔过质心）；和分别为由到和的向径。3机器人技术第六章

按静力学方法，把这些力、力矩简化到的固联坐标系，可得：或式中(为杆的质量)。

求出和在轴上的分量，就得到了关节力和扭矩，它们就是在忽略摩擦之后，驱动器为使操作机保持静力平衡所应提供的关节力或关节力矩，记作，其大小为4机器人技术第六章

当忽略杆件自重时，上式可简记为：

若以表示不计重力的关节力或力矩值，对于转动关节则有：

式中——是自到杆的质心的向径。5机器人技术第六章

例1求两杆操作机的静关节力矩(坐标系与结构尺寸如图)。

解：设已知6机器人技术第六章7机器人技术第六章8机器人技术第六章二、操作机的静力平衡

设有操作机如图所示，每个关节都作用有关节力矩(广义驱动力，指向的正向)，在末端执行器的参考点处将产生力和力矩。由于、是操作机作用于外界对象的力和力矩，为了和输入关节力矩一起进行运算，故应取负值。9机器人技术第六章利用虚功原理建立静力平衡方程，令于是，操作机的总虚功是：根据虚功原理，若系统处于平衡，则总虚功(虚功之和)为0，即10机器人技术第六章式中

J——是速度分析时引出的雅可比矩阵，其元素为相应的偏速度。由机器人运动微分关系可知，，则有因为是独立坐标，则，所以有

上式是针对操作机的关节力和执行器参考点间所产生的力和力矩之间的关系式。

该式表明关节空间和直角坐标空间广义力可以借助于雅可比矩阵J进行变换。这种变换关系，也可推广到任两杆间固联直角坐标系中的广义力变幻，这时应将关节空间与直角坐标空间的雅可比矩阵，换作直角坐标空间的雅可比矩阵。11机器人技术第六章

例2如图，操作机的手爪正在持板手扭某一哩栓，手爪上方联接一测力传感器可测六维力向量(力和力矩)。试确定测力传感器和扭动板手时力和力矩的关系。12机器人技术第六章解：设在测力传感器上置坐标系Sf()，在螺栓上置坐标系S

()。在图示瞬间，两坐标系彼此平行。因为刚体的无限小位移(平移和转动)可表示为六维向量，故对二者的微位移可分别表示为：由于两坐标系的坐标轴平行，于是可以得到：13机器人技术第六章

前式也可以从前图直观求得。设

为相应于的广义力向量，为相应于的广义力向量，则可得：

上式也可直接用虚功原理求得。14机器人技术第六章一、研究目的：1、合理地确定各驱动单元（以下称关节）的电机功率。2、解决对伺服驱动系统的控制问题（力控制）

在机器人处于不同位置图形（位形）时，各关节的有效惯量及耦合量都会发生变化（时变的），因此，加于各关节的驱动力也应是时变的，可由动力学方程给以确定。6-2机器人动力学概述二、机器人动力学研究的问题可分为两类：

1、给定机器人的驱动力（矩），用动力学方程求解机器人（关节）的运动参数或动力学效应（即已知,求和，称为动力学正问题。）。

2、给定机器人的运动要求，求应加于机器人上的驱动力（矩）（即已知和，求,称为动力学逆问题）。15机器人技术第六章三、动力学研究方法：1．拉格朗日方程法：通过动、势能变化与广义力的关系，建立机器人的动力学方程。代表人物R.P.Paul、J.J.Uicker、J.M.Hollerbach等。计算量O(n4)，经优化O(n3)，递推O(n)。2．牛顿—欧拉方程法：用构件质心的平动和相对质心的转动表示机器人构件的运动，利用动静法建立基于牛顿—欧拉方程的动力学方程。代表人物Orin,Luh(陆养生)等。计算量O(n)。3．高斯原理法:利用力学中的高斯最小约束原理,把机器人动力学问题化成极值问题求解.代表人物波波夫(苏).用以解决第二类问题。计算量O(n3)。4．凯恩方程法：引入偏速度概念，应用矢量分析建立动力学方程。该方法在求构件的速度、加速度及关节驱动力时，只进行一次由基础到末杆的推导，即可求出关节驱动力，其间不必求关节的约束力，具有完整的结构，也适用于闭链机器人。计算量O(n!)。16机器人技术第六章

系统的动能和势能可在任何坐标系（极坐标系、圆柱坐标系等）中表示

，不是一定在直角坐标系中。

动力学方程为：

广义力

广义速度

广义坐标（力或力矩）（或）（或）

6.3二杆机器人的拉格朗日方程应用质点系的拉格朗日方程来处理杆系的问题。

定义：L=K-PL—Lagrange函数；K—系统动能之和；P—系统势能之和。6.3.1刚体系统拉格朗日方程17机器人技术第六章

设二杆机器人臂杆长度分别为，质量分别集中在端点为，坐标系选取如图。以下分别计算方程中各项：

一、动能和势能

对质点：势能：

动能：

（负号与坐标系建立有关）

对质点：

先写出直角坐标表达式：

6.3.2刚体系统拉格朗日方程18机器人技术第六章对求导得速度分量：

动能：势能：

二、Lagrange函数

19机器人技术第六章三、动力学方程

先求第一个关节上的力矩

——（1）20机器人技术第六章同理，对和微分，可求得第二关节力矩

以上是两杆机器人动力学模型。——（2）21机器人技术第六章系数D的物理意义：

—关节的有效惯量（等效转动惯量的概念）。由关节处的加速度引起的关节处的力矩为（）

—关节和之间的耦合惯量。由关节或的加速度（或）所引起的关节和处的力矩为或

—向心力项系数。表示关节处的速度作用在关节处的向心力（）—向心力项系数。表示关节处的速度作用在本身关节处的向心力（）四、动力学方程中各系数的物理意义

将前面结果重新写成简单的形式

：22机器人技术第六章—哥氏力项系数。两项组合为关节与处的速度作用在关节处的哥氏力，哥氏力是由于牵连运动是转动造成的。

—关节处的重力项。重力项只与大小、长度以及机构的结构图形（）有关。

比较二杆机器人例中的系数与一般表达式中的系数得到有效惯量系数：

耦合惯量系数：

23机器人技术第六章向心力项系数：

哥氏力项系数：

重力项：

24机器人技术第六章6.4机器人的拉格朗日方程的一般表达形式

从上节容易看出Lagrange方程是一个二阶耦合、非线性和微分方程，为简化计算，未虑及传动链中的摩擦。以下方程的推导，也是不考虑传动链带来的摩擦影响，只考虑杆件本身，然后再加入关节处驱动装置（如电机、码盘等）的影响。

推导分五步进行：一、计算任意任意杆件上任意点的速度；二、计算动能；三、计算势能；四、形成Lagrange函数；五、建立动力学方程。25机器人技术第六章其速度为：

一、点的速度

由于整个系统的动能都是在基础系中考虑的，故需求系统各质点在基础坐标系中的速度。对于杆坐标系中的一点，它在基础坐标系中的位置为式中—变换矩阵速度平方为：

式中—矩阵的迹，即矩阵主对角元素之和。26机器人技术第六章二、动能

位于杆上处质量为的质点的动能是：27机器人技术第六章则杆的动能（在基础坐标系中）为：令式中称为连杆的伪惯量矩阵。则得到杆的动能为：对于杆上任意一点的（在杆坐标系中）可以表示为：28机器人技术第六章根据理论力学中惯性矩、惯性积和静矩的定义，引入下列记号：对坐标轴的惯性矩：则有：29机器人技术第六章对坐标轴的惯性积：对坐标轴的静矩：质量之和：于是：xzyr30机器人技术第六章同理：于是能够表达为：机器人臂杆总的动能是：31机器人技术第六章如果考虑到关节处驱动装置的动能：

调换求迹与求和运算顺序，并加入关节处驱动装置的动能，得到机器人总的动能为：（对于移动关节：）式中为关节处驱动装置的转动惯量。三、势能

设杆的质心在再其自身坐标系的位置向量为，则它在基础坐标系中的位置向量为32机器人技术第六章设重力加速度在基础坐标系中的齐次分量为：于是机器人的总势能为：则杆在基础坐标系中的势能为：（一般认为基础坐标系的z轴取向上方）33机器人技术第六章先求拉格朗日方程中的各项：四、拉格朗日函数五、动力学方程（1)34机器人技术第六章由于是对称矩阵，则有：合并(a)式中前两项，得到：（1’)当时，中不包含以后关节变量，即：于是可得：35机器人技术第六章（2)交换其中的部分哑元，得到：36机器人技术第六章（3)37机器人技术第六章将以上各项带入拉格朗日公式，并用和分别代替上式中的哑元和，得到：上式为拉格朗日方程的最后形式。这些方程与求和的次序无关，因此可将上式写为简化形式：（5)（4)38机器人技术第六章式中：

以上的动力学方程(5)中系数D的意义与上节所列相同，即分别为有效惯量项系数(),耦合惯量项系数（），向心力项系数（），哥氏力项系数（），重力项等。39机器人技术第六章

动力学方程中的惯量项和重力项在机器人控制重特别重要，将直接系统的稳定性和定位精度。只有当机器人高速运动时，向心力项和哥氏力项才是重要的。传动装置的惯量值往往较大，对系统动态特性的影响也不可忽略。

在机器人动力学问题的讨论中，拉格朗日动力学方程常写作更简化的一般形式：式中：的意义见（5)式。（6)40机器人技术第六章乘法次数：6.5机器人的牛顿—欧拉方程

机器人的拉格朗日动力学模型为非线性二阶常微分方程，利用这些方程，由已知的每一轨迹设定点的关节位置、速度和加速度，可以计算各关节的标称力矩，但拉格朗日方程利用4×4齐次变换矩阵，使得计算效率太低。加法次数：

为了实现实时控制，曾用过略去哥氏力和向心力的简化模型，但当操作机快速运动时，哥氏力和向心力在计算关节力矩中是相当重要的。因而这种简化只能用于机器人的低速运动，在典型的制造业环境中，这是不合乎要求的。此外，这种简化所引起的关节力矩误差，不能用反馈控制校正。

牛顿—欧位法采用迭代形式方程，计算速度快，可用于实时控制，因而成为一种常用的建模方法。41机器人技术第六章

寻求转动坐标系和固定惯性坐标系之间必要的数学关系,再推广到运动坐标系(转动和平移)和惯性坐标系之间的关系。如图,惯性坐标系O-XYZ和转动坐标系O-X*Y*Z*

的原点重合于O点。而OX*、OY*、OZ*轴相对OX、OY、OZ轴旋转。设和分别为这两个坐标系沿主轴的单位矢量。转动坐标系中点P可用它在任一坐标系中的分量来表示：6.5.1转动坐标系或在惯性坐标系中的运动：YXZrY*X*Z*OP在转动坐标系中的运动：42机器人技术第六章在惯性坐标系中的运动：（7)

需要解决转动坐标系坐标轴在惯性坐标系中的导数问题。我们假定，转动坐标系绕着过原点O的某轴OQ以角速度

旋转。方向沿OQ轴，指向转动坐标系右旋方向。则可以证明转动坐标系中的任意固定矢量在惯性坐标系中的导数为：XZYsY*X*Z*OQ43机器人技术第六章于是由（6)式可得：这是建立转动坐标系两种时间导数之间关系的基本方程。方程（9)又被称为哥氏定理。（8)（9)44机器人技术第六章6.5.2运动坐标系如图,运动坐标系O-X*Y*Z*

相对于惯性坐标系O-XYZ转动和平移。质量为M的质点P

分别以和确定相对于惯性坐标系和运动坐标系的原点的位置。原点O*

相对于原点O的位置以矢量表示。则有：rYXZOPY*X*Z*O*r*h（10)（11)45机器人技术第六章6.5.3杆件运动学

根据前述运动坐标系的概念，推导一组数学方程，描述机器人的运动杆件相对于基础坐标系的运动学关系。

令

和分别为坐标系相对于基础坐标系的线速度和角速度。令和分别为杆件i坐标系相对于基础坐标系和杆件i-1坐标系的角速度。则杆件i坐标系相对于基础坐标系的线速度和角速度分别是：

坐标系是基础坐标系，而坐标系和分别固联于杆件i-1和杆件i上，原点分别为Oi-1和Oi

。原点Oi相对于原点O和原点Oi-1的位置分别用位置矢量

和

表示。原点Oi-1相对于基础坐标系原点O的位置用位置矢量

表示。46机器人技术第六章式中d*(.)／dt

表示在运动坐标系的时间导数。（12)（13)47机器人技术第六章（14)（15)

为坐标系相对于的角加速度:

根据机器人杆件坐标系建立的步骤和参数的定义，杆件i在杆件i–1坐标系中的运动是沿方向的平移或绕转动。因此，式中是杆件i相对于杆件i-1

坐标系的角速度值。若杆件i转动若杆件i平移（16)48机器人技术第六章（18)类似地（17)若杆件i转动若杆件i平移由式（13)和式（16)有：若杆件i转动若杆件i平移若杆件i转动若杆件i平移（19)若杆件i转动若杆件i平移由式（15)、式（16)和式（17)有：若杆件i转动若杆件i平移（20)（21)由式（15)、式（16)和式（17)有：49机器人技术第六章（22)若杆件i转动若杆件i平移由式（12)、式（13)和式（20)有：利用矢量叉乘积的恒等式并根据式（14)、式（15)和式（19)有：—（23)若杆件i转动若杆件i平移50机器人技术第六章

刚体的运动可分解为随质心的移动和绕质心的转动。借助于杆件运动学知识，我们把达朗贝尔原理用于每个杆件，描述机器人各杆件的运动。达朗贝尔原理可应用于任意瞬时，它实质上是牛顿第二运动定律的一种变型，可表示为：

6.5.4牛顿——欧拉法基本运动方程

牛顿定理

:欧拉方程:式中：—杆i质量；

—杆i上所有外力合力；

—杆i上所有外力对质心的合力矩；

—杆i绕其质心惯性矩阵。51机器人技术第六章根据力（矩）平衡原理，在质心处有：则有（24)方程（24)即为牛顿——欧拉法的基本方程。

52机器人技术第六章

上面推导的牛顿——欧拉法（也简称N-E法）方程式含关节联接的约束力（矩），没有显示地表示输入—输出关系，不适合进行动力学分析和控制器设计。如果变换成由一组完备且独立的位置变量（质心位置变量通常不是相互独立的）和输入力来描述，这些变量都显式地出现在动力学方程中，即得到显式的输入——输出形式表示的动力学方程，称为封闭形式的动力学方程（拉格朗日方程即是封闭的）。6.5.5递推形式的牛顿——欧拉方程

关节变量是一组完备且独立的变量，关节力（矩）是一组从约束力（矩）中分解出来的独立的输入，所以用和来描述方程，可以得到封闭形式的动力学方程。53机器人技术第六章

根据N-E法的基本方程，利用质心运动变量与关节变量及关节运动变量之间的关系以及约束力与关节力矩之间的关系，消去中间变量，可以得到封闭形式的动力学方程。但显然不如用拉格朗日法简单，特别是当机器人自由度较多时，更是如此。因此，对于N-E法，常用的不是它的封闭形式方程，而是它的递推形式方程。方程（24）可直接写成如下递推形式：（25)而关节力（矩）可写成如下形式：

（26)式中，为沿关节轴线的单位矢量，为关节的粘滞阻尼系数。54机器人技术第六章

递推形式的N-E法方程与封闭形式方程比较，计算量从减少到：乘法次数：117n–24，加法次数：103n-21，从而大大加快了计算速度。自由度越多，递推形式的优势越明显。对于典型n=6的情形，递推形式的计算效率几乎提高10倍。因此，常用于实时计算。递推形式方程的特点是其计算从机器人操作机的一个杆到另一杆逐个顺序进行的，它充分利用了操作机的串联链特性，常用于求解动力学逆问题（即已知，求）。

求解的大致过程为：根据运动和力的不同传递方向，进行运动量的向前迭代和力学量的向后迭代。具体步骤如下：55机器人技术第六章动力学计算运动学计算

1．确定计算N-E方程所需的所有运动量，包括每个杆件的（）由杆1杆n：2.将上述运动量代入N-E方程，确定关节力（矩）。计算顺序与运动量计算相反，由杆n杆1：

56机器人技术第六章

前述递推运动方程的明显缺点是所有惯性矩阵和物理几何参数（如）等，都是以基础坐系为参照的，因此，当机器人运动时，它们也随着变化。Luh等人改进了上述N-E方程，将所有杆件的速度、加速度、惯性矩阵、质心位置、力和力矩等，都表示在各杆的自身坐标系中，从而使计算更加简单。这种改进的最重要的成果是，计算关节驱动力矩的时间不仅与机器人关节数成线性比例，而且与机器人构型无关。这就有可能在关节变量空间实现机器人的实时控制算法。6.5.6在杆件自身坐标系中的递推方程

设是3×3旋转矩阵，它把矢量由坐标系变换到坐标系中。

57机器人技术第六章

这样，可不计算相对基础坐标系的和等，而是直接计算在杆件自身坐标系中的和等。于是有关运动量的递推公式变为：若杆件i转动若杆件i平移若杆件i转动若杆件i平移若杆件i转动若杆件i平移58机器人技术第六章关节间约束力公式变为：

因此，概括地说，高效的牛顿一欧拉运动方程是一组正向和反向的递推方程，每一杆件的动力学和运动学参数都是以其自身坐标系为参照的。59机器人技术第六章6.6机器人的凯恩方程法简介

凯恩(Kane)方法是用来建立机器人机构动力学模型的一种普遍方法，其基本思想是以广义速率代替广义坐标作为系统的独立变量，它用达朗倍尔原理及虚位移原理建立动力学方程。凯恩方法既适合于完整系统，也适合于非完整系统。6.6.1广义速率和偏速度及偏角速度一、广义速率一个具有n个自由度的完整系统，相对于惯性坐标系的运动一般通过n个独立的广义坐标来描述。

n个广义速度也是独立的，故可用n个广义速度的线性组合，即n个广义速率(或称准速度)

来描述系统的运动，即60机器人技术第六章式中：为及t的函数；而由组成的系数矩阵应为非奇异阵。则有二、偏速度系统中任意质点p的径矢为为广义坐标及t的函数，则该点的速度为（27)（28)61机器人技术第六章令其中

称广义速率前的系数矢量为p点相对于惯性坐标系的第r偏速度。一般说来它是广义坐标和时间t的函数。对于定常系统，偏速度只是广义坐标的矢量函数。（29)（31)（30)三、偏角速度62机器人技术第六章

从式(30)可见，广义速率的取法不同，系统内同一质点及同一刚体的偏速度也可不同。故可通过一定的技巧来选取广义速率，使得到的偏速度和偏角速度具有最简单的形式。最理想的是使较多的偏速度和偏角速度等于零，这样有利于简化动力学方程。一般选择与系统的运动密切相关的量，如选取系统中刚体的角速度分量或质点的速度分量为广义速率，以使刚体的角速度和质点的速度具有最简单的表达形式。作为特例，如果取广义速度为广义速率，即可见对于广义速度的偏速度为。63机器人技术第六章6.6.2凯恩动力学方程四、刚体各点偏速度由达朗倍尔原理和虚位移原理推得的系统的动力学普遍方程：

系统中p点的速度，对于具有n个自由度的系统，可写成广义速率的线性组合，即（32)（33)64机器人技术第六章式中。如果可积分，则为另一种定义的广义坐标。（34)从式(34)可得到的变分，即将上式代入式(33)得65机器人技术第六章改变求和的形式得（34)令称为系统对应于的广义主动力称为系统对应于的广义惯性力66机器人技术第六章这样，式（34）成为：由于为独立的变分，所以有（35)

上式称为凯恩动力学方程，意为广义上动力与广义惯性力之相等于零。凯恩方程法可以得到封闭形式的动力学方程。67机器人技术第六章6.7弹性机器人动力学简介6.7.1机器人系统的弹性问题

通常，机器人机构的手臀、驱动、传动元件被假设为刚性的，故系统的建模及控制方案设计都是以这样一个刚性假设