第七讲机器人动力学PPT讲稿.ppt

《第七讲机器人动力学PPT讲稿.ppt》由会员分享，可在线阅读，更多相关《第七讲机器人动力学PPT讲稿.ppt（78页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、第七讲机器人动力学第1页，共78页，编辑于2022年，星期二第四章第四章 机器人动力学机器人动力学2022/10/182022/10/18动力学研究的问题动力学研究的问题：机器人各个关节的运动与关节需要机器人各个关节的运动与关节需要的驱动力（矩）之间的关系。的驱动力（矩）之间的关系。正问题正问题：已知关节运动，求：已知关节运动，求 关节驱动力（矩）。关节驱动力（矩）。逆问题逆问题：已知关节驱动力（矩），：已知关节驱动力（矩），求关节运动。求关节运动。第2页，共78页，编辑于2022年，星期二数学模型数学模型：关节运动关节运动位移、速度、加速度变化位移、速度、加速度变化 关节驱动力（矩）关节驱动

2、力（矩）驱动力或驱动力矩驱动力或驱动力矩i动力学方程动力学方程：，i=1，n正问题正问题：已知：已知 ，求，求i。逆问题逆问题：已知：已知i ，求，求 。第四章第四章 机器人动力学机器人动力学2022/10/182022/10/18第3页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型1 1、力学分析、力学分析2 2、拉格朗日方程法、拉格朗日方程法3 3、动力学模型、动力学模型2022/10/182022/10/18第4页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型1 1、力学分析、力学分析2022/10/182022/10/18（1 1）静

3、力学分析）静力学分析 机器人各个关节处于静止状态。机器人各个关节处于静止状态。当负载为一重物时：当负载为一重物时：关节承受的力和力矩：关节承受的力和力矩：关节需要的驱动力（矩）：关节需要的驱动力（矩）：mgf3=mgf2=mgf1=mgm2=mgl2l2l1m1=mg(l1+l2)1=02=mgl23=mg第5页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型1 1、力学分析、力学分析2022/10/182022/10/18（1 1）静力学分析）静力学分析 机器人各个关节处于静止状态。机器人各个关节处于静止状态。考虑杆件自重时：考虑杆件自重时：关节承受的力和力矩：关节承

4、受的力和力矩：关节需要的驱动力（矩）：关节需要的驱动力（矩）：mgf3=mgf2=mgf1=mgm2=mgl2l2l1m1=mg(l1+l2)1=02=mgl23=mgm3gm2gm1g第6页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型1 1、力学分析、力学分析2022/10/182022/10/18（2 2）动力学分析）动力学分析 机器人各个关节处于运动状态。机器人各个关节处于运动状态。当负载为一重物时：当负载为一重物时：关节承受的力和力矩：关节承受的力和力矩：关节需要的驱动力（矩）：关节需要的驱动力（矩）：f3f2f1m2l2l1m1123m3第7页，共78页，

5、编辑于2022年，星期二4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法2022/10/182022/10/18拉格朗日方程的一般形式为：拉格朗日方程的一般形式为：式中，式中，广义力，它可以是力，也可以是力矩；广义力，它可以是力，也可以是力矩；系统选定的广义坐标；系统选定的广义坐标；广义坐标对时间的一阶导数，即速度；广义坐标对时间的一阶导数，即速度；拉格朗日函数，又称为拉格朗日算子，它被定拉格朗日函数，又称为拉格朗日算子，它被定义为系统的动能与势能之差义为系统的动能与势能之差L=T-U。第8页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型2

6、2、拉格朗日方程法、拉格朗日方程法2022/10/182022/10/18 对给定的机器人，可以按以下几个步骤建立拉对给定的机器人，可以按以下几个步骤建立拉格朗日动力学方程：格朗日动力学方程：（1 1）选取完全并独立的广义坐标；）选取完全并独立的广义坐标；（2 2）选定广义力；）选定广义力；（3 3）求出系统的动能）求出系统的动能T T和势能和势能U U，并用其构造拉格，并用其构造拉格朗日函数朗日函数L L=T T-U U；（4 4）将以上结果代入拉格朗日方程式中，即可求）将以上结果代入拉格朗日方程式中，即可求得机器人的动力学方程。得机器人的动力学方程。第9页，共78页，编辑于2022年，星期

7、二4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法2022/10/182022/10/18例：例：已知二关节机器人如图所示，机器人的两个已知二关节机器人如图所示，机器人的两个连杆长度分别为连杆长度分别为l1和和l2，质量分别为，质量分别为m1和和m2，且集，且集中在各连杆的端部。若将机器人直接悬挂在加速中在各连杆的端部。若将机器人直接悬挂在加速度为度为g的重力场中，试用拉格朗日方程建立该机器的重力场中，试用拉格朗日方程建立该机器人的动力学方程。人的动力学方程。解：解：选取连杆绕关节的转角选取连杆绕关节的转角为变量为变量1和和2，则系统的广义，则系统的广义坐标就可以选为

8、坐标就可以选为 ，即，即 转动关节对应的是力矩，转动关节对应的是力矩，所以广义力就选为所以广义力就选为 ，即即 。12m1m2xy关节关节1 1关节关节2 2第10页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法2022/10/182022/10/18求出各连杆的动能和势能：求出各连杆的动能和势能：连杆连杆l1的动能为：的动能为：连杆连杆l1的势能为：的势能为：对连杆对连杆l2求动能和势能时，要先写出其质心在直求动能和势能时，要先写出其质心在直角坐标系中的位置表达式：角坐标系中的位置表达式：然后求微分，则其速度就为：然后求微分，则

9、其速度就为：由此可得连杆的速度平方值为：由此可得连杆的速度平方值为：第11页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法2022/10/182022/10/18求出各连杆的动能和势能：求出各连杆的动能和势能：从而连杆从而连杆l2的动能为：的动能为：势能为：势能为：则可构造出拉格朗日函数为：则可构造出拉格朗日函数为：第12页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法2022/10/182022/10/18求出机器人动力学方程：求出机器人动力学方程：先将拉格朗日函数

10、对先将拉格朗日函数对 和和 进行微分，即：进行微分，即：第13页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法2022/10/182022/10/18求出机器人动力学方程：求出机器人动力学方程：再将拉格朗日函数对再将拉格朗日函数对 和和 进行微分，即：进行微分，即：第14页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法2022/10/182022/10/18求出机器人动力学方程：求出机器人动力学方程：将以上结果代入方程即可得关节上的力矩分别为：将以上结果代入方程即可得

11、关节上的力矩分别为：第15页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型3 3、动力学模型、动力学模型2022/10/182022/10/18将得到的机器人动力学方程简写为如下形式：将得到的机器人动力学方程简写为如下形式：当机器人有当机器人有n个关节时，上式可推广为普遍形式：个关节时，上式可推广为普遍形式：第16页，共78页，编辑于2022年，星期二4.1 4.1 动力学模型动力学模型3 3、动力学模型、动力学模型2022/10/182022/10/18将上式进一步简化为如下所示的矩阵形式：将上式进一步简化为如下所示的矩阵形式：上式也称为机器人的动力学模型。上式也称

12、为机器人的动力学模型。式中：式中：是机器人动力学模型中的惯性力项，是机器人动力学模型中的惯性力项，表示机器人操作机的质量矩阵，它是表示机器人操作机的质量矩阵，它是nn阶的对阶的对称矩阵，。称矩阵，。是是n1阶矩阵，表示机器人动力学模型中非线性的耦阶矩阵，表示机器人动力学模型中非线性的耦合力项，包括离心力（自耦力）和哥氏力（互耦力）。合力项，包括离心力（自耦力）和哥氏力（互耦力）。也是也是n1阶矩阵，表示机器人动力学模型中的重力项。阶矩阵，表示机器人动力学模型中的重力项。第17页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/1

13、81 1、牛顿、牛顿欧拉方程欧拉方程2 2、递推计算公式、递推计算公式3 3、递推算法应用、递推算法应用第18页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/18牛顿牛顿欧拉方程原理欧拉方程原理：将机器人的每个杆件看成刚体，：将机器人的每个杆件看成刚体，并确定每个杆件质心的位置和表征其质量分布的惯性并确定每个杆件质心的位置和表征其质量分布的惯性张量矩阵。当确定机器人坐标系后，根据机器人关节张量矩阵。当确定机器人坐标系后，根据机器人关节速度和加速度，则可先由机器人机座开始向手部杆件速度和加速度，则可先由机器人机座开始向手部杆件

14、正向递推正向递推出每个杆件在自身坐标系中的速度和加速度，再用牛出每个杆件在自身坐标系中的速度和加速度，再用牛顿顿欧拉方程得到机器人每个杆件上的惯性力和惯性力矩，欧拉方程得到机器人每个杆件上的惯性力和惯性力矩，然后再由机器人末端关节开始向第一个关节然后再由机器人末端关节开始向第一个关节反向递推反向递推出机器出机器人每个关节上承受的力和力矩，最终得到机器人每个关节所需人每个关节上承受的力和力矩，最终得到机器人每个关节所需要的驱动力（矩），这样就确定了机器人关节的驱动力（矩）要的驱动力（矩），这样就确定了机器人关节的驱动力（矩）与关节位移、速度和加速度之间的函数关系，即建立了机器人与关节位移、速度和

15、加速度之间的函数关系，即建立了机器人的动力学方程。的动力学方程。第19页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/18牛顿牛顿欧拉方程递推过程欧拉方程递推过程：正向递推正向递推：已知机器人各个关节的速度和加速度：已知机器人各个关节的速度和加速度从从1n递递推出机器人每个杆件在自身坐标系中的速度和加速度推出机器人每个杆件在自身坐标系中的速度和加速度机机器人每个杆件质心上的速度和加速度器人每个杆件质心上的速度和加速度再用牛顿再用牛顿欧欧拉方程得到机器人每个杆件质心上的惯性力和惯性力拉方程得到机器人每个杆件质心上的惯性力和惯性

16、力矩。矩。反向递推反向递推：根据正向递推的结果：根据正向递推的结果从从n1递推出机器人每递推出机器人每个关节上承受的力和力矩个关节上承受的力和力矩得到机器人每个关节所需要得到机器人每个关节所需要的驱动力（矩）。的驱动力（矩）。第20页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/181 1、牛顿、牛顿欧拉方程欧拉方程（1 1）牛顿方程）牛顿方程惯性力惯性力 矢量。矢量。质心上的线加速度。质心上的线加速度。第21页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10

17、/181 1、牛顿、牛顿欧拉方程欧拉方程（2 2）欧拉方程）欧拉方程惯性力矩惯性力矩 矢量。矢量。质心上的惯性张量矩阵。质心上的惯性张量矩阵。第22页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/181 1、牛顿、牛顿欧拉方程欧拉方程（2 2）欧拉方程）欧拉方程惯性力矩惯性力矩惯性张量矩阵：惯性张量矩阵：a.a.坐标系：与杆件坐标系同向，位于杆件质心上。坐标系：与杆件坐标系同向，位于杆件质心上。b.b.元素名称：元素名称：Icxx，Icyy，Iczz惯性矩；惯性矩；Icxy=Icyx,Icyz=Iczy,Iczx=Icxz惯

18、性积。惯性积。第23页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/181 1、牛顿、牛顿欧拉方程欧拉方程（2 2）欧拉方程）欧拉方程惯性力矩惯性力矩惯性张量矩阵：惯性张量矩阵：理论计算方法：理论计算方法：实验测试法：实验测试法：惯量摆仪器。惯量摆仪器。第24页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/182 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：已知机器人各个关节的速度和加速度：已知机器人各个关节的速度和加速度：从从1n递推出机

19、器人每个杆件在自身坐标系中的速度递推出机器人每个杆件在自身坐标系中的速度和加速度；和加速度；机器人每个杆件质心上的速度和加速度；机器人每个杆件质心上的速度和加速度；机器人每个杆件质心上的惯性力和惯性力矩。机器人每个杆件质心上的惯性力和惯性力矩。第25页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/182 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：以第一种杆件坐标系为例以第一种杆件坐标系为例杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式建立相邻两个杆件的坐标系：建立相邻两个杆件的坐标系：i-1i-1

20、、i i。Oiii-1关节关节iXi-1Z i-1Oi-1XiZi第26页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式已知：已知：i i关节速度和加速度关节速度和加速度 i-1 i-1杆件速度和加速度杆件速度和加速度计算：计算：i i杆件速度和杆件速度和 加速度加速度2022/10/182022/10/18ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第27页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧

21、拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式分析：分析：I I、坐标系、坐标系:相邻杆件位姿矩阵相邻杆件位姿矩阵IIII、关节速度和加速度、关节速度和加速度 的矢量化：的矢量化：2022/10/182022/10/18ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第28页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式2022/10/182022/10

22、/18ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第29页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式2022/10/182022/10/18ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第30页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式2022/10/18202

23、2/10/18关节关节iii-1Xi-1Z i-1Oi-1XiZiOi第31页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件质心上的速度和加速度杆件质心上的速度和加速度2022/10/182022/10/18iXiZiOi第32页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件质心上的惯性力和惯性力矩杆件质心上的惯性力和惯性力矩惯性力惯性力：惯性力矩惯性力矩：2022/10/182022/10/

24、18iXiZiOi第33页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/182 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：以第二种杆件坐标系为例以第二种杆件坐标系为例杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式建立相邻两个杆件的坐标系：建立相邻两个杆件的坐标系：i-1i-1、i i。ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第34页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度

25、和加速度递推计算公式杆件速度和加速度递推计算公式已知：已知：i i关节速度和加速度关节速度和加速度 i-1 i-1杆件速度和加速度杆件速度和加速度计算：计算：i i杆件速度和加速度杆件速度和加速度2022/10/182022/10/18ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第35页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式分析：分析：I I、坐标系、坐标系:相邻杆件位姿矩阵相邻杆件位姿矩阵IIII、关节速度和加速度、关节

26、速度和加速度 的矢量化：的矢量化：2022/10/182022/10/18ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第36页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式2022/10/182022/10/18ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第37页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速

27、度递推计算公式杆件速度和加速度递推计算公式2022/10/182022/10/18ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第38页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件质心上的速度和加速度杆件质心上的速度和加速度2022/10/182022/10/18iXiZiOi第39页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件质心上的惯性力和惯性力矩杆件质心上的惯性力和惯性力矩

28、惯性力惯性力：惯性力矩惯性力矩：2022/10/182022/10/18iXiZiOi第40页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/10/182022/10/182 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：已知机器人各个杆件的惯性力和惯性力矩：已知机器人各个杆件的惯性力和惯性力矩：从从n1递推出机器人每个关节承受的力和力矩；递推出机器人每个关节承受的力和力矩；机器人每个关节的驱动力或驱动力矩。机器人每个关节的驱动力或驱动力矩。第41页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2022/

29、10/182022/10/182 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：以第二种杆件坐标系为例以第二种杆件坐标系为例关节承受的力和力矩关节承受的力和力矩 递推计算公式递推计算公式 建立相邻两个杆件的建立相邻两个杆件的坐标系：坐标系：i-1i-1、iiii-1关节关节iXi-1Z i-1Oi-1XiZiOi第42页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节承受的力和力矩关节承受的力和力矩 递推计算公式递推计算公式已知：已知：i-1i-1杆件的惯性力杆件的惯性力 和惯性力

30、矩和惯性力矩 i i关节承受的力和力矩关节承受的力和力矩计算：计算：i-1i-1关节承受的力和关节承受的力和 力矩力矩2022/10/182022/10/18ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第43页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节承受的力和力矩关节承受的力和力矩 递推计算公式递推计算公式分析：分析：I I、坐标系、坐标系:相邻杆件位姿矩阵相邻杆件位姿矩阵IIII、i-1i-1杆件受力分析：杆件受力分析：2022/10/182022/10/18ii-1关节关

31、节iXi-1Z i-1Oi-1XiZiOi第44页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节承受的力和力矩关节承受的力和力矩 递推计算公式递推计算公式以以i-1i-1杆件为研究对象，杆件为研究对象，由达朗贝尔原理可得：由达朗贝尔原理可得：2022/10/182022/10/18i-1关节关节iXi-1Z i-1Oi-1Oi第45页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节承受的力和力矩

32、关节承受的力和力矩 递推计算公式递推计算公式以以i-1i-1杆件为研究对象，杆件为研究对象，由达朗贝尔原理可得：由达朗贝尔原理可得：2022/10/182022/10/18i-1关节关节iXi-1Z i-1Oi-1Oi第46页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节驱动力（矩）关节驱动力（矩）平移关节：平移关节：回转关节：回转关节：则关节驱动力（矩）为：则关节驱动力（矩）为：2022/10/182022/10/18i-1关节关节iXi-1Z i-1Oi-1第47页，共78页，编辑于202

33、2年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用（1 1）递推初始条件）递推初始条件正向递推正向递推机座机座0 0的速度和加速度：的速度和加速度：*考虑杆件自重或手部负载为重物时：考虑杆件自重或手部负载为重物时：为描述在机座坐标系为描述在机座坐标系00中的标准重力加速度。中的标准重力加速度。2022/10/182022/10/18gx0z0o0第48页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用（1 1）递推初始条件）递推初始条件反向递推反向递推机器人手部负载：机器人手部负载：202

34、2/10/182022/10/18第49页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用（2 2）递推应用条件）递推应用条件已知机器人的关节变量已知机器人的关节变量 及其速度及其速度 和加速度和加速度 ；已知任一杆件已知任一杆件i i相对于与自身坐标系相对于与自身坐标系ii方向相同的坐标方向相同的坐标系系CCi i 所描述的惯性张量所描述的惯性张量 及其质心在自身坐标系及其质心在自身坐标系ii中中的位置矢量的位置矢量 （可用实验等方法确定）；（可用实验等方法确定）；已知相邻杆件的位姿矩阵及必要的初始数据。已知相邻杆件的位姿矩阵

35、及必要的初始数据。2022/10/182022/10/18第50页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用（2 2）递推应用条件）递推应用条件第二种坐标系下递推算法第二种坐标系下递推算法正向递推正向递推:2022/10/182022/10/18第51页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用（2 2）递推应用条件）递推应用条件第二种坐标系下递推算法第二种坐标系下递推算法反向递推反向递推:2022/10/182022/10/18第52页，共78页，编

36、辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用例：已知二自由度机器人如例：已知二自由度机器人如图所示，机器人两个杆件的图所示，机器人两个杆件的长度分别为长度分别为 和和 ，且其质，且其质量量 和和 都集中在杆件的端都集中在杆件的端头。若用第二种方法建立机头。若用第二种方法建立机器人的坐标系，当机器人各器人的坐标系，当机器人各个关节的位移个关节的位移 、速度、速度 和加速度和加速度 已知时，试用已知时，试用牛顿牛顿欧拉递推算法计算欧拉递推算法计算各关节的驱动力矩。各关节的驱动力矩。2022/10/182022/10/1812m1m2xy关节关

37、节1 1关节关节2 2第53页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：建立坐标系如图所示。解：建立坐标系如图所示。相邻杆件的位姿矩阵为：相邻杆件的位姿矩阵为：2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2第54页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推已知关节速度和加速度分别为已知关节速度和加速度分别为 ，由于考虑杆件的重量，所以，由于考虑杆件的重量，

38、所以机座的运动参数（初始条件）机座的运动参数（初始条件）设为：设为：2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第55页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第56页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推20

39、22/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第57页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第58页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关

40、节关节2 2x1x2y1y2g第59页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第60页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第61页，共78页，编辑于2022年，星期

41、二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第62页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第63页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推

42、算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第64页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第65页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022

43、/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第66页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第67页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推 由于机器人手部无负载，由于机器人手部无负载，所以初始条件为：所以初始条件为：2022/10/182

44、022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第68页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节2 2受的力和力矩：受的力和力矩：2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第69页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节2 2受的力和力矩：受的力和力矩：2022/

45、10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第70页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节2 2的驱动力矩：的驱动力矩：2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第71页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1受的力和力矩：受的力和力矩：2

46、022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第72页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1受的力和力矩：受的力和力矩：2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第73页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1受的力和力矩：受的

47、力和力矩：2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第74页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1的驱动力矩：的驱动力矩：2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第75页，共78页，编辑于2022年，星期二4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1和和2 2

48、的驱动力矩为：的驱动力矩为：2022/10/182022/10/1812m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第76页，共78页，编辑于2022年，星期二习习 题题1.1.机器人动力学解决什么问题？什么是动力学正问题和逆问机器人动力学解决什么问题？什么是动力学正问题和逆问题？题？2.2.写出动力学模型，并简述各项的含义写出动力学模型，并简述各项的含义?3.3.什么是牛顿方程？什么是欧拉方程？有何作用？什么是牛顿方程？什么是欧拉方程？有何作用？4.4.什么是惯性张量矩阵？如何计算？什么是惯性张量矩阵？如何计算？5.5.正向递推的作用是什么正向递推的作用是什么?分哪几步实现？分哪几步实现？6.6.反向递推的作用是什么反向递推的作用是什么?分哪几步实现？分哪几步实现？7.7.正向递推和反向递推的初始条件各是什么？当考虑杆正向递推和反向递推的初始条件各是什么？当考虑杆件自重或手部负载为重物时，初始条件有何变化？件自重或手部负载为重物时，初始条件有何变化？2022/10/182022/10/18第77页，共78页，编辑于2022年，星期二习习 题题2022/10/182022/10/18400400m第78页，共78页，编辑于2022年，星期二