机器人技术第六章.ppt

《机器人技术第六章.ppt》由会员分享，可在线阅读，更多相关《机器人技术第六章.ppt（73页珍藏版）》请在三一办公上搜索。

1、机器人技术,陶建国,哈尔滨工业大学机电学院2005.2.,第六章 机器人静力学和动力学,静力学和动力学分析，是机器人操作机设计和动态性能分析的基础。特别是动力学分析，它还是机器人控制器设计、动态仿真的基础。机器人静力学研究机器人静止或缓慢运动式，作用在机器人上的力和力矩问题。特别是当手端与环境接触时，各关节力（矩）与接触力的关系。,机器人动力学研究机器人运动与关节驱动力（矩）间的动态关系。描述这种动态关系的微分方程称为动力学模型。由于机器人结构的复杂性，其动力学模型也常常很复杂，因此很难实现基于机器人动力学模型的实时控制。然而高质量的控制应当基于被控对象的动态特性，因此，如何合理简化机器人动力

2、学模型，使其适合于实时控制的要求，一直是机器人动力学研究者追求的目标。,6.1 机器人静力学,一、杆件之间的静力传递,在操作机中，任取两连杆，。设在杆 上的 点作用有力矩 和力；在杆 上作用有自重力 过质心）；和 分别为由 到 和 的向径。,按静力学方法，把这些力、力矩简化到 的固联坐标系，可得：,或,式中(为杆 的质量)。,求出 和 在 轴上的分量，就得到了关节力和扭矩，它们就是在忽略摩擦之后，驱动器为使操作机保持静力平衡所应提供的关节力或关节力矩，记作，其大小为,当忽略杆件自重时，上式可简记为：,若以 表示不计重力的关节力或力矩值，对于转动关节则有：,式中 是自 到杆 的质心 的向径。,例

3、1 求两杆操作机的静关节力矩(坐标系与结构尺寸如图)。,解：设已知,二、操作机的静力平衡,设有操作机如图所示，每个关节都作用有关节力矩(广义驱动力，指向 的正向)，在末端执行器的参考点 处将产生力 和力矩。由于、是操作机作用于外界对象的力和力矩，为了和输入关节力矩 一起进行运算，故应取负值。,利用虚功原理建立静力平衡方程，令,于是，操作机的总虚功是：,根据虚功原理，若系统处于平衡，则总虚功(虚功之和)为0，即,式中 J 是速度分析时引出的雅可比矩阵，其元素为相应 的偏速度。,由机器人运动微分关系可知，则有,因为 是独立坐标，则，所以有,上式是针对操作机的关节力和执行器参考点 间所产生的力和力矩

4、之间的关系式。,该式表明关节空间和直角坐标空间广义力可以借助于雅可比矩阵 J 进行变换。这种变换关系，也可推广到任两杆间固联直角坐标系中的广义力变幻，这时应将关节空间与直角坐标空间的雅可比矩阵，换作直角坐标空间的雅可比矩阵。,例2 如图，操作机的手爪正在持板手扭某一哩栓，手爪上 方联接一测力传感器可测六维力向量(力和力矩)。试确定测力传感器和扭动板手时力和力矩的关系。,解：设在测力传感器上置坐标系 Sf()，在螺栓上置坐标系 S()。在图示瞬间，两坐标系彼此平行。因为刚体的无限小位移(平移和转动)可表示为六维向量，故对二者的微位移可分别表示为：,由于两坐标系的坐标轴平行，于是可以得到：,前式也

5、可以从前图直观求得。设 为相应于 的广义力向量，为相应于 的广义力向量，则可得：,上式也可直接用虚功原理求得。,一、研究目的：1、合理地确定各驱动单元（以下称关节）的电机功率。2、解决对伺服驱动系统的控制问题（力控制）,在机器人处于不同位置图形（位形）时，各关节的有效惯量及耦合量都会发生变化（时变的），因此，加于各关节的驱动力也应是时变的，可由动力学方程给以确定。,6-2 机器人动力学概述,二、机器人动力学研究的问题可分为两类：1、给定机器人的驱动力（矩），用动力学方程求解机器 人（关节）的运动参数或动力学效应（即已知,求 和，称为动力学正问题。）。2、给定机器人的运动要求，求应加于机器人上的

6、驱动力（矩）（即已知 和，求,称为动力学逆问题）。,三、动力学研究方法：1拉格朗日方程法：通过动、势能变化与广义力的关系，建立机器人的动力学方程。代表人物、等。计算量O(n4)，经优化O(n3)，递推O(n)。2牛顿欧拉方程法：用构件质心的平动和相对质心的转动表示机器人构件的运动，利用动静法建立基于牛顿欧拉方程的动力学方程。代表人物Orin,Luh(陆养生)等。计算量O(n)。,3高斯原理法:利用力学中的高斯最小约束原理,把机器人动力学问题化成极值问题求解.代表人物波波夫(苏).用以解决第二类问题。计算量O(n3)。4凯恩方程法：引入偏速度概念，应用矢量分析建立动力学方程。该方法在求构件的速度

7、、加速度及关节驱动力时，只进行一次由基础到末杆的推导，即可求出关节驱动力，其间不必求关节的约束力，具有完整的结构，也适用于闭链机器人。计算量O(n!)。,系统的动能和势能可在任何坐标系（极坐标系、圆柱坐 标系等）中表示，不是一定在直角坐标系中。,动力学方程为：广义力 广义速度 广义坐标（力或力矩）（或）（或）,6.3 二杆机器人的拉格朗日方程,应用质点系的拉格朗日方程来处理杆系的问题。,定义：L=K-P LLagrange函数；K系统动能之和；P系统势能之和。,6.3.1 刚体系统拉格朗日方程,设二杆机器人臂杆长度分别为，质量分别集中在端点为，坐标系选取如图。,以下分别计算方程中各项：,一、动

8、能和势能,对质点：,势能：,动能：,（负号与坐标系建立有关）,对质点：,先写出直角坐标表达式：,6.3.2 刚体系统拉格朗日方程,对 求导得速度分量：,动能：,势能：,二、Lagrange函数,三、动力学方程,先求第一个关节上的力矩,（1）,同理，对 和 微分，可求得第二关节力矩,以上是两杆机器人动力学模型。,（2）,系数 D 的物理意义：,关节 的有效惯量（等效转动惯量的概念）。由关节 处的加速度 引起的关节 处的力矩为（）,关节 和 之间的耦合惯量。由关节 或 的加速度（或）所引起的关节 和 处的力矩为 或,向心力项系数。表示关节 处的速度作用在本身关节处 的向心力（）,四、动力学方程中各

9、系数的物理意义 将前面结果重新写成简单的形式：,哥氏力项系数。两项组合为关节 与 处的速度作用在关节 处的哥氏力，哥氏力是由于 牵连运动是转动造成的。,关节 处的重力项。重力项只与 大小、长度 以 及机构的结构图形（）有关。,比较二杆机器人例中的系数与一般表达式中的系数得到有效惯量系数：,耦合惯量系数：,向心力项系数：,哥氏力项系数：,重力项：,6.4 机器人的拉格朗日方程的一般表达形式,从上节容易看出Lagrange方程是一个二阶耦合、非线性和微分方程，为简化计算，未虑及传动链中的摩擦。以下方程的推导，也是不考虑传动链带来的摩擦影响，只考虑杆件本身，然后再加入关节处驱动装置（如电机、码盘等）

10、的影响。,推导分五步进行：,一、计算任意任意杆件上任意点的速度；二、计算动能；三、计算势能；四、形成Lagrange函数；五、建立动力学方程。,其速度为：,一、点的速度,由于整个系统的动能都是在基础系中考虑的，故需求系统各质点在基础坐标系中的速度。,对于杆 坐标系中的一点，它在基础坐标系中的位置为,式中 变换矩阵,速度平方为：,式中 矩阵的迹，即矩阵主对角元素之和。,二、动能,位于杆 上 处质量为 的质点的动能是：,则杆 的动能（在基础坐标系中）为：,令式中 称为连杆 的伪惯量矩阵。,则得到杆 的动能为：,对于杆 上任意一点的（在杆 坐标系中）可以表示为：,根据理论力学中惯性矩、惯性积和静矩的

11、定义，引入下列记号：,对坐标轴的惯性矩：,则有：,对坐标轴的惯性积：,对坐标轴的静矩：,质量之和：,于是：,同理：,于是 能够表达为：,机器人臂杆总的动能是：,如果考虑到关节处驱动装置的动能：,调换求迹与求和运算顺序，并加入关节处驱动装置的动能，得到机器人总的动能为：,（对于移动关节：）,式中 为关节 处驱动装置的转动惯量。,三、势能,设杆 的质心在再其自身坐标系的位置向量为，则它在基础坐标系中的位置向量 为,设重力加速度 在基础坐标系中的齐次分量为：,于是机器人的总势能为：,则杆在基础坐标系中的势能为：,（一般认为基础坐标系的 z 轴取向上方）,先求拉格朗日方程中的各项：,四、拉格朗日函数,

12、五、动力学方程,（1),由于 是对称矩阵，则有：,合并(a)式中前两项，得到：,（1),当 时，中不包含 以后关节变量，即：,于是可得：,（2),交换其中的部分哑元，得到：,（3),将以上各项带入拉格朗日公式，并用 和 分别代替上式中的哑元 和，得到：,上式为拉格朗日方程的最后形式。这些方程与求和的次序无关，因此可将上式写为简化形式：,（5),（4),式中：,以上的动力学方程(5)中系数 D的意义与上节所列相同，即分别为有效惯量项系数(),耦合惯量项系数（），向心力项系数（），哥氏力项系数（），重力项等。,动力学方程中的惯量项和重力项在机器人控制重特别重要，将直接系统的稳定性和定位精度。只有当

13、机器人高速运动时，向心力项和哥氏力项才是重要的。传动装置的惯量值往往较大，对系统动态特性的影响也不可忽略。,在机器人动力学问题的讨论中，拉格朗日动力学方程常写作更简化的一般形式：,式中：,的意义见（5)式。,（6),乘法次数：,6.5 机器人的牛顿欧拉方程,机器人的拉格朗日动力学模型为非线性二阶常微分方程，利用这些方程，由已知的每一轨迹设定点的关节位置、速度和加速度，可以计算各关节的标称力矩，但拉格朗日方程利用44齐次变换矩阵，使得计算效率太低。,加法次数：,为了实现实时控制，曾用过略去哥氏力和向心力的简化模型，但当操作机快速运动时，哥氏力和向心力在计算关节力矩中是相当重要的。因而这种简化只能

14、用于机器人的低速运动，在典型的制造业环境中，这是不合乎要求的。此外，这种简化所引起的关节力矩误差，不能用反馈控制校正。牛顿欧位法采用迭代形式方程，计算速度快，可用于实时控制，因而成为一种常用的建模方法。,寻求转动坐标系和固定惯性坐标系之间必要的数学关系,再推广到运动坐标系(转动和平移)和惯性坐标系之间的关系。如图,惯性坐标系O-XYZ和转动坐标系O-X*Y*Z*的原点重合于O点。而OX*、OY*、OZ*轴相对OX、OY、OZ轴旋转。设 和 分别为这两个坐标系沿主轴的单位矢量。转动坐标系中点 P 可用它在任一坐标系中的分量来表示：,6.5.1 转动坐标系,或,在惯性坐标系中的运动：,在转动坐标系

15、中的运动：,在惯性坐标系中的运动：,（7),需要解决转动坐标系坐标轴在惯性坐标系中的导数问题。我们假定，转动坐标系绕着过原点O的某轴OQ以角速度 旋转。方向沿OQ轴，指向转动坐标系右旋方向。则可以证明转动坐标系中的任意固定矢量 在惯性坐标系中的导数为：,于是由（6)式可得：,这是建立转动坐标系两种时间导数之间关系的基本方程。,方程（9)又被称为哥氏定理。,（8),（9),6.5.2 运动坐标系,如图,运动坐标系O-X*Y*Z*相对于惯性坐标系O-XYZ转动和平移。质量为M 的质点P 分别以 和 确定相对于惯性坐标系和运动坐标系的原点的位置。原点O*相对于原点O的位置以矢量 表示。则有：,（10

16、),（11),6.5.3 杆件运动学,根据前述运动坐标系的概念，推导一组数学方程，描述机器人的运动杆件相对于基础坐标系的运动学关系。,令 和 分别为坐标系 相对于基础坐标系 的线速度和角速度。令 和 分别为杆件i坐标系 相对于基础坐标系 和杆件 i-1坐标系 的角速度。则杆件 i 坐标系 相对于基础坐标系的线速度 和角速度 分别是：,坐标系 是基础坐标系，而坐标系 和 分别固联于杆件 i-1和杆件 i 上，原点分别为 Oi-1和 Oi。原点 Oi 相对于原点 O 和原点 Oi-1 的位置分别用位置矢量 和 表示。原点 Oi-1相对于基础坐标系原点 O 的位置用位置矢量 表示。,式中 d*(.)

17、dt 表示在运动坐标系 的时间导数。,（12),（13),（14),（15),为坐标系 相对于 的角加速度:,根据机器人杆件坐标系建立的步骤和参数的定义，杆件 i 在杆件 i 1 坐标系中的运动是沿 方向的平移或绕 转动。因此，,式中 是杆件 i 相对于杆件 i-1 坐标系的角速度值。,（16),（18),类似地,由式（13)和式（16)有：,由式（15)、式（16)和式（17)有：,（21),由式（15)、式（16)和式（17)有：,由式（12)、式（13)和式（20)有：,利用矢量叉乘积的恒等式,并根据式（14)、式（15)和式（19)有：,（23),若杆件 i 转动若杆件 i 平移,刚体

18、的运动可分解为随质心的移动和绕质心的转动。借助于杆件运动学知识，我们把达朗贝尔原理用于每个杆件，描述机器人各杆件的运动。达朗贝尔原理可应用于任意瞬时，它实质上是牛顿第二运动定律的一种变型，可表示为：,6.5.4 牛顿欧拉法基本运动方程,牛顿定理:,欧拉方程:,式中：杆i 质量；杆i上所有外力合力；杆i上所有外力对质心的合力矩；杆i 绕其质心惯性矩阵。,根据力（矩）平衡原理，在质心处有：,则有,（24),方程（24)即为牛顿欧拉法的基本方程。,上面推导的牛顿欧拉法（也简称N-E法）方程式含关节联接的约束力（矩），没有显示地表示输入输出关系，不适合进行动力学分析和控制器设计。如果变换成由一组完备且

19、独立的位置变量（质心位置变量通常不是相互独立的）和输入力来描述，这些变量都显式地出现在动力学方程中，即得到显式的输入输出形式表示的动力学方程，称为封闭形式的动力学方程（拉格朗日方程即是封闭的）。,6.5.5 递推形式的牛顿欧拉方程,关节变量 是一组完备且独立的变量，关节力（矩）是一组从约束力（矩）中分解出来的独立的输入，所以用 和来描述方程，可以得到封闭形式的动力学方程。,根据N-E法的基本方程，利用质心运动变量与关节变量及关节运动变量之间的关系以及约束力与关节力矩之间的关系，消去中间变量，可以得到封闭形式的动力学方程。但显然不如用拉格朗日法简单，特别是当机器人自由度较多时，更是如此。因此，对

20、于N-E法，常用的不是它的封闭形式方程，而是它的递推形式方程。方程（24）可直接写成如下递推形式：,（25),而关节力（矩）可写成如下形式：,（26),式中，为沿关节轴线 的单位矢量，为关节的粘滞阻尼系数。,递推形式的N-E法方程与封闭形式方程比较，计算量从减少到：乘法次数：117n 24，加法次数：103n-21，从而大大加快了计算速度。自由度越多，递推形式的优势越明显。对于典型 n=6 的情形，递推形式的计算效率几乎提高10倍。因此，常用于实时计算。递推形式方程的特点是其计算从机器人操作机的一个杆到另一杆逐个顺序进行的，它充分利用了操作机的串联链特性，常用于求解动力学逆问题（即已知，求）。

21、,求解的大致过程为：根据运动和力的不同传递方向，进行运动量的向前迭代和力学量的向后迭代。具体步骤如下：,1确定计算N-E方程所需的所有运动量，包括每个杆件的（）由杆1 杆n：,2.将上述运动量代入N-E方程，确定关节力（矩）。计算顺 序与运动量计算相反，由杆n 杆1：,前述递推运动方程的明显缺点是所有惯性矩阵和物理几何参数（如）等，都是以基础坐系为参照的，因此，当机器人运动时，它们也随着变化。Luh等人改进了上述N-E方程，将所有杆件的速度、加速度、惯性矩阵、质心位置、力和力矩等，都表示在各杆的自身坐标系中，从而使计算更加简单。这种改进的最重要的成果是，计算关节驱动力矩的时间不仅与机器人关节数

22、成线性比例，而且与机器人构型无关。这就有可能在关节变量空间实现机器人的实时控制算法。,6.5.6 在杆件自身坐标系中的递推方程,设 是33旋转矩阵，它把矢量由坐标系 变换到坐标系 中。,这样，可不计算相对基础坐标系的 和 等，而是直接计算在杆件自身坐标系中的和 等。于是有关运动量的递推公式变为：,若杆件 i 转动若杆件 i 平移,若杆件 i 转动若杆件 i 平移,关节间约束力公式变为：,因此，概括地说，高效的牛顿一欧拉运动方程是一组正向和反向的递推方程，每一杆件的动力学和运动学参数都是以其自身坐标系为参照的。,6.6 机器人的凯恩方程法简介,凯恩(Kane)方法是用来建立机器人机构动力学模型的

23、一种普遍方法，其基本思想是以广义速率代替广义坐标作为系统的独立变量，它用达朗倍尔原理及虚位移原理建立动力学方程。凯恩方法既适合于完整系统，也适合于非完整系统。,6.6.1 广义速率和偏速度及偏角速度,一、广义速率 一个具有n 个自由度的完整系统，相对于惯性坐标系 的运动一般通过 n 个独立的广义坐标 来描述。n 个广义速度 也是独立的，故可用n 个广义速度的线性组合，即n 个广义速率(或称准速度)来描述系统的运动，即,式中：为 及 t 的函数；而由 组成的系数矩阵应为非奇异阵。则有,二、偏速度 系统中任意质点 p 的径矢为 为广义坐标 及t 的函数，,则该点的速度为,（27),（28),令,其

24、中,称广义速率 前的系数矢量 为 p点相对于惯性坐标系的第 r 偏速度。一般说来它是广义坐标 和时间t 的函数。对于定常系统，偏速度只是广义坐标的矢量函数。,（29),（31),（30),三、偏角速度,从式(30)可见，广义速率的取法不同，系统内同一质点及同一刚体的偏速度也可不同。故可通过一定的技巧来选取广义速率，使得到的偏速度和偏角速度具有最简单的形式。最理想的是使较多的偏速度和偏角速度等于零，这样有利于简化动力学方程。一般选择与系统的运动密切相关的量，如选取系统中刚体的角速度分量或质点的速度分量为广义速率，以使刚体的角速度和质点的速度具有最简单的表达形式。作为特例，如果取广义速度为广义速率

25、，即,可见对于广义速度 的偏速度为。,6.6.2 凯恩动力学方程,四、刚体各点偏速度,由达朗倍尔原理和虚位移原理推得的系统的动力学普遍方程：,系统中 p 点的速度，对于具有n 个自由度的系统，可写成广义速率的线性组合，即,（32),（33),式中。如果 可积分，则 为另一种定义的广义坐标。,（34),从式(34)可得到 的变分，即,将上式代入式(33)得,改变求和的形式得,（34),令,称为系统对应于 的广义主动力,称为系统对应于 的广义惯性力,这样，式（34）成为：,由于 为独立的变分，所以有,（35),上式称为凯恩动力学方程，意为广义上动力与广义惯性力之相等于零。,凯恩方程法可以得到封闭形

26、式的动力学方程。,6.7 弹性机器人动力学简介,6.7.1 机器人系统的弹性问题,通常，机器人机构的手臀、驱动、传动元件被假设为刚性的，故系统的建模及控制方案设计都是以这样一个刚性假设为前提的。结构刚性越好越不易振动，机器人精度越高，经过近似处理的控制方法也越精确、可行。随着工业的发展，对机器人性能要求越来越高。如：要求机器人重量轻以降低能耗；运行速度快，以提高劳动生产率；定位精度高，以适应更多的精密作业要求。另外，对于如太空机器人所处的特殊环境要求具有超长手臂的机器人，其结构已不再是刚性结构，而必须计入曾被忽略的系统弹性或非线性因素，这便使系统设计、建模及控制变得更为复杂。,关于具有弹性的机

27、器入系统的建模与控制问题的研究历史不长，始于70年代初，研究具有弹性附件的飞机动力学模型的动力学分析问题，计入分布质量和柔性效应的机器人机构在低速运动下的动力学，对具有分布质量和弹性影响的二连杆机械手提出反馈控制方法。近年来，关于这方面的研究发展很快，大多以研究单弹性臂机器人的建模与控制入手。本节将以单弹性臂机器人机构为例，介绍弹性手臂机器人的建模方法。,机器人系统的弹性主要来源于两个方面，由于臂本身的弹性而引起的变形及运行过程中的振动。由驱动系统的弹性及非线性因素而引起的振动。在机器人驱动系统中，存在着轴与轴承之间的库仑摩擦，传动装置中的齿轮间隙及谐波齿轮减速器的弹性等因素。,6.7.2 机

28、器人机构的弹性及非线性问题,一、建模方法。弹性手臂机器人是一分布参数系统，其运动特性由一组非线性偏微分方程描述。在系统仿真和应用设计时必须作有限维的近似，并在不影响系统稳定性性态的前提下化为可实际控制的系统状态方程。解决弹性手臂机器人的建模问题的各种建模方法，在不同程度上部有一定的近似性。准确性及可行性是衡量一种方法好坏的标准，就现有文献资料大致可归纳为以下几种：（1）拉格朗日方程结合模态展开法；（2）拉格朗日方程结合有限元素法；（3）牛顿一欧拉方程结合模态展开法；（4）牛顿一欧拉方程结合有限元素法；（5）哈密顿原理结合模态分析法。,6.7.3 主要研究内容,二、控制方程 现在应用于机器人控制中的最佳控制法、极点配置法均以系统不产生振荡为前提，而弹性手臂机器人系统对其控制器的要求就是要能控制其弹性振动。因而有效可行的控制方法的研究很有必要。对控制方案的要求：（1）必须同时控制刚体运动及弹性振动而控制输出量仅作用于关节处；（2）避免溢漏现象；（3）控制方案所要求的传感器数量应尽可能少，且安装简单、方便。三、带有弹性构件的新型机械结构。,设T1为驱动部分动能、T2为手臂部分动能、T3为负载动能，则,6.7.4 单弹性臂机构的建模,