机器人动力学 (2).ppt
现在学习的是第1页，共27页现在学习的是第2页，共27页 前面我们所研究的机器人运动学都是在稳态下进行的，没有考虑机器人运动的动态过程。实际上，机器人的动态性能不仅与运动学相对位置有关，还与机器人的结构形式、质量分布、执行机构的位置、传动装置等因案有关。机器人动态性能由动力学方程描述，动力学是考虑上述因素，研究机器人运动与关节力(力矩)间的动态关系。描述这种动态关系的微分方程称为机器人动力学方程。机器人动力学要解决两类问题：动力学正问题和逆问题。现在学习的是第3页，共27页 动力学正问题是根据关节驱动力矩或力，计算机器人的运动(关节位移、速度和加速度)；动力学逆问题是已知轨迹对应的关节位移、速度和加速度，求出所需要的关节力矩或力。不考虑机电控制装置的惯性、摩擦、间隙、饱和等因素时，n 自由度机器人动力方程为n个二阶耦合非线性微分方程。方程中包括惯性力/力矩、哥氏力/力矩、离心力/力矩及重力/力矩，是一个耦合的非线性多输入多输出系统。对机器人动力学的研究，所采用的方法很多，有拉格朗日(Lagrange)方法、牛顿一欧拉(NewtonEuler)、高斯(Gauss)、凯恩(Kane)、旋量对偶数、罗伯逊一魏登堡(RobersonWittenburg)等方法。现在学习的是第4页，共27页 研究机器人动力学的目的是多方面的。动力学正问题与机器人的仿真有关；逆问题是为了实时控制的需要，利用动力学模型，实现最优控制，以期达到良好的动态性能和最优指标。在设计中需根据连杆质量、运动学和动力学参数、传动机构特征和负载大小进行动态仿真，从而决定机器人的结构参数和传动方案，验算设计方案的合理性和可行性，以及结构优化程度。在离线编程时，为了估计机器人高速运动引起的动载荷和路径偏差，要进行路径控制仿真和动态模型仿真。这些都需要以机器人动力学模型为基础。研究机器人动力学的目的现在学习的是第5页，共27页5.1 机器人静力学 机器人静力学研究机器人静止或者缓慢运动时作用在手臂上的力和力矩问题，特别是当手端与外界环境有接触力时，各关节力矩与接触力的关系。下图表示作用在机器人手臂杆件i上的力和力矩。其i-1fi为杆件i-1对杆i的作用力，-ifi+1为杆i+1对杆i的作用力，i-1Ni为杆件i-1对杆i的作用力矩，-iNi+1为杆i+1对杆i的作用力矩，ci为杆i质心。作用在杆i的力和力矩现在学习的是第6页，共27页根据力、力矩平衡原理有现在学习的是第7页，共27页5.2 机器人动力学正问题 机器人动力学正问题研究机器人手臂在关节力矩作用下的动态响应。其主要内容是如何建立机器人手臂的动力学方程。建立机器人动力学方程的方法有牛顿欧拉法和拉格朗日法等。现在学习的是第8页，共27页1、牛顿欧拉法方程 在考虑速度与加速度影响的情况下，作用在机器人手臂杆i上的力和力矩如右图所示。其中vci和i分别为杆i质心的平移速度向量和此杆的角速度向量。根据力、力矩平衡原理有:5-15-2称5-1为牛顿方程，5-2为欧拉方程。现在学习的是第9页，共27页其中Ii为杆i绕其质心的惯性张量现在学习的是第10页，共27页2、拉格朗日方程 牛顿一欧拉运动学方程是基于牛顿第二定律和欧拉方程，利用达朗伯原理，将动力学问题变成静力学问题求解。该方法计算快。拉格朗日动力学则是基于系统能量的概念，以简单的形式求得非常复杂的系统动力学方程，并具有显式结构，物理意义比较明确。(1)拉格朗日函数 对于任何机械系统，拉格朗日函数L定义为系统总的动能Ek与总的势能Ep之差，即:(,)(,)()kpL q qEq qEq12nqqqq12nqqqq表示动能与势能的广义坐标相应的广义速度现在学习的是第11页，共27页 (2)机器人系统动能 在机器人中，连杆是运动部件，连杆i的动能Eki为连杆质心线速度引起的动能和连杆角速度产生的动能之和，即:1122TiTiikiiciciiiiEmI 1nkkiiEE1(,)()2TkE q qq D q q系统的动能为n个连杆的动能之和，即：现在学习的是第12页，共27页 由于 和 是关节变量 和关节速度 的函数，因此，从上式可知，机器人的动能是关节变量和关节速度的标量函数，记为 ，可表示成：1(,)()2TkE q qq D q qciiiqq(,)kE q q 式中，是nxn阶的机器人惯性矩阵()D q现在学习的是第13页，共27页 3机器人系统势能 设连杆i的势能为 ，连杆i的质心在O坐标系中的位置矢量为 ，重力加速度矢量在坐标系中为g，则：机器人系统的势能为各连杆的势能之和，即：它是q的标量函数。TpiiciEm g p 1npipiiEEpiEcip现在学习的是第14页，共27页 4拉格朗日方程 系统的拉格朗日方程为：上式又称为拉格朗日欧拉方程，简称LE方程。式中，是n个关节的驱动力或力矩矢量，上式可写成：pkkEEEddtqqqdLLdtqq现在学习的是第15页，共27页 例平面RP机器人如图所示，连杆l和连杆2的质量分别为m1和m2，质心的位置由l1和d2所规定，惯量矩阵为：1111100000 xxyyzzIIIiI2222200000 xxyyzzIIIiI现在学习的是第16页，共27页(1)取坐标，确定关节变量和驱动力或力矩 建立连杆D-H坐标系如上图所示，关节变量为1+/2为求解方便，此处取关节变量为1和d2，关节驱动力矩l和力f2。现在学习的是第17页，共27页(2)系统动能 由式(1)，分别得22211 111 11122kyyEmlI2222222122111()22kyyEm ddI22221 1122212211()22kyyyyEmlIIm dm d1122TiTiikiiciciiiiEmI 1总动能为：现在学习的是第18页，共27页(3)系统势能 因为：00Tgg11 11 10Tcpl cl s11111 1TpcEm g pm gl s 22222 1TpcEm g pm gd s 1 1221()pEg mlm ds则：总势能为：现在学习的是第19页，共27页221 11222122()yyyykmlIIm dEqm d222 10kEm dq1 12212 1()pEg mlm d cgm sq(4)偏导数现在学习的是第20页，共27页2211 11222122 121 1221222222 121()2()yyyymlIIm dm ddg mlm d cm dm dm gs(5)拉格朗日动力学方程 将偏导数代入拉格朗日方程，得到平面RP机器人的动力学方程的封闭形式：pkkEEEddtqqq拉格朗日方程2现在学习的是第21页，共27页()(,)()D q qH q qG q221 1122220()0yyyymlIIm dD qm22 12222 12(,)m ddH q qm d1 122121()()mlm dgcG qm gs(1)关节空间动力学方程 将式2写成矩阵形式：3、关节空间与操作空间动力学式中3现在学习的是第22页，共27页 式(3)为机器人在关节空间中的动力学方程封闭形式的一般结构式。它反映了关节力或力矩与关节变量、速度和加速度之间的函数关系。对于n个关节的机器人，是nn正定对称矩阵，是q的函数，称为机器人惯性矩阵；是n1的离心力和哥氏力向量；是n1重力矢量，与机器人的形位q有关。()D q(,)H q q()G q现在学习的是第23页，共27页()(,)()xxxFMq xUq qG q 2操作空间动力学方程 与关节空间动力学方程相对应，在笛卡尔操作空间中，操作力F与末端加速度 之间的关系可表示为：x()xMq(,)xUq q()xG q操作空间中的惯性矩阵离心力和哥氏力矢量重力矢量xF广义操作力矢量机器人末端位姿向量现在学习的是第24页，共27页()TJq F()xJ q q()()()(,)rxJ q qJ q qJ q qa q q()()()()TxD qJq Mq J q(,)()(,)()9)(,)TTxrH q qJq Uq qJqq a q q()()()TxG qJq G q由上一章可知，广义操作力和关节力之间的关系为：操作空间与关节空间之间的速度与加速度的关系：比较关节空间与操作空间动力学方程，可以得到：现在学习的是第25页，共27页()()(,)()TxxxJq Mq xUq qG q 3关节力矩操作运动方程 机器人动力学最终是研究其关节输入力矩与其输出的操作运动之间的关系由式(4)和(5)，得(6)：()(,)()xxxFMq xUq qG q()TJq F456式(6)反映了输入关节力与机器人运动之间的关系。现在学习的是第26页，共27页 思考题1 什么是拉格朗日函数？简述用拉格朗日方法建立机器人动力学方程的步骤。现在学习的是第27页，共27页
