第七讲机器人动力学.pptx

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

1、第四章第四章 机器人动力学机器人动力学17 17 二月二月 2023 2023动力学研究的问题动力学研究的问题：机器人各个关节的运动与关节机器人各个关节的运动与关节需要的驱动力（矩）之间的关系。需要的驱动力（矩）之间的关系。正问题正问题：已知关节运动，求：已知关节运动，求 关节驱动力（矩）。关节驱动力（矩）。逆问题逆问题：已知关节驱动力（矩），：已知关节驱动力（矩），求关节运动。求关节运动。第1页/共79页数学模型数学模型：关节运动关节运动位移、速度、加速度变化位移、速度、加速度变化 关节驱动力（矩）关节驱动力（矩）驱动力或驱动力矩驱动力或驱动力矩i动力学方程动力学方程：，i=1，n正问题正问

2、题：已知：已知 ，求，求i。逆问题逆问题：已知：已知i ，求，求 。第四章第四章 机器人动力学机器人动力学17 17 二月二月 2023 2023第2页/共79页4.1 4.1 动力学模型动力学模型1 1、力学分析、力学分析2 2、拉格朗日方程法、拉格朗日方程法3 3、动力学模型、动力学模型17 17 二月二月 2023 2023第3页/共79页4.1 4.1 动力学模型动力学模型1 1、力学分析、力学分析17 17 二月二月 2023 2023（1 1）静力学分析）静力学分析 机器人各个关节处于静止状态。机器人各个关节处于静止状态。当负载为一重物时：当负载为一重物时：关节承受的力和力矩：关节

3、承受的力和力矩：关节需要的驱动力（矩）：关节需要的驱动力（矩）：mgf3=mgf2=mgf1=mgm2=mgl2l2l1m1=mg(l1+l2)1=02=mgl23=mg第4页/共79页4.1 4.1 动力学模型动力学模型1 1、力学分析、力学分析17 17 二月二月 2023 2023（1 1）静力学分析）静力学分析 机器人各个关节处于静止状态。机器人各个关节处于静止状态。考虑杆件自重时：考虑杆件自重时：关节承受的力和力矩：关节承受的力和力矩：关节需要的驱动力（矩）：关节需要的驱动力（矩）：mgf3=mgf2=mgf1=mgm2=mgl2l2l1m1=mg(l1+l2)1=02=mgl23=

4、mgm3gm2gm1g第5页/共79页4.1 4.1 动力学模型动力学模型1 1、力学分析、力学分析17 17 二月二月 2023 2023（2 2）动力学分析）动力学分析 机器人各个关节处于运动状态。机器人各个关节处于运动状态。当负载为一重物时：当负载为一重物时：关节承受的力和力矩：关节承受的力和力矩：关节需要的驱动力（矩）：关节需要的驱动力（矩）：f3f2f1m2l2l1m1123m3第6页/共79页4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法17 17 二月二月 2023 2023拉格朗日方程的一般形式为：拉格朗日方程的一般形式为：式中，式中，广义力，它可以

5、是力，也可以是力矩；广义力，它可以是力，也可以是力矩；系统选定的广义坐标；系统选定的广义坐标；广义坐标对时间的一阶导数，即速度；广义坐标对时间的一阶导数，即速度；拉格朗日函数，又称为拉格朗日算子，拉格朗日函数，又称为拉格朗日算子，它被定义为系统的动能与势能之差它被定义为系统的动能与势能之差L=T-U。第7页/共79页4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法17 17 二月二月 2023 2023 对给定的机器人，可以按以下几个步骤建立拉对给定的机器人，可以按以下几个步骤建立拉格朗日动力学方程：格朗日动力学方程：（1 1）选取完全并独立的广义坐标；）选取完全并独

6、立的广义坐标；（2 2）选定广义力；）选定广义力；（3 3）求出系统的动能）求出系统的动能T T和势能和势能U U，并用其构造拉格，并用其构造拉格朗日函数朗日函数L L=T T-U U；（4 4）将以上结果代入拉格朗日方程式中，即可求）将以上结果代入拉格朗日方程式中，即可求得机器人的动力学方程。得机器人的动力学方程。第8页/共79页4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法17 17 二月二月 2023 2023例：例：已知二关节机器人如图所示，机器人的两个已知二关节机器人如图所示，机器人的两个连杆长度分别为连杆长度分别为l1和和l2，质量分别为，质量分别为m1

7、和和m2，且集，且集中在各连杆的端部。若将机器人直接悬挂在加速中在各连杆的端部。若将机器人直接悬挂在加速度为度为g的重力场中，试用拉格朗日方程建立该机器的重力场中，试用拉格朗日方程建立该机器人的动力学方程。人的动力学方程。解：解：选取连杆绕关节的转角选取连杆绕关节的转角为变量为变量1和和2，则系统的广义，则系统的广义坐标就可以选为坐标就可以选为 ，即，即 转动关节对应的是力矩，转动关节对应的是力矩，所以广义力就选为所以广义力就选为 ，即即 。12m1m2xy关节关节1 1关节关节2 2第9页/共79页4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法17 17 二月二月

8、 2023 2023求出各连杆的动能和势能：求出各连杆的动能和势能：连杆连杆l1的动能为：的动能为：连杆连杆l1的势能为：的势能为：对连杆对连杆l2求动能和势能时，要先写出其质心在直求动能和势能时，要先写出其质心在直角坐标系中的位置表达式：角坐标系中的位置表达式：然后求微分，则其速度就为：然后求微分，则其速度就为：由此可得连杆的速度平方值为：由此可得连杆的速度平方值为：第10页/共79页4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法17 17 二月二月 2023 2023求出各连杆的动能和势能：求出各连杆的动能和势能：从而连杆从而连杆l2的动能为：的动能为：势能为：

9、势能为：则可构造出拉格朗日函数为：则可构造出拉格朗日函数为：第11页/共79页4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法17 17 二月二月 2023 2023求出机器人动力学方程：求出机器人动力学方程：先将拉格朗日函数对先将拉格朗日函数对 和和 进行微分，即：进行微分，即：第12页/共79页4.1 4.1 动力学模型动力学模型2 2、拉格朗日方程法、拉格朗日方程法17 17 二月二月 2023 2023求出机器人动力学方程：求出机器人动力学方程：再将拉格朗日函数对再将拉格朗日函数对 和和 进行微分，即：进行微分，即：第13页/共79页4.1 4.1 动力学模型

10、动力学模型2 2、拉格朗日方程法、拉格朗日方程法17 17 二月二月 2023 2023求出机器人动力学方程：求出机器人动力学方程：将以上结果代入方程即可得关节上的力矩分别为：将以上结果代入方程即可得关节上的力矩分别为：第14页/共79页4.1 4.1 动力学模型动力学模型3 3、动力学模型、动力学模型17 17 二月二月 2023 2023将得到的机器人动力学方程简写为如下形式：将得到的机器人动力学方程简写为如下形式：当机器人有当机器人有n个关节时，上式可推广为普遍形式：个关节时，上式可推广为普遍形式：第15页/共79页4.1 4.1 动力学模型动力学模型3 3、动力学模型、动力学模型17

11、17 二月二月 2023 2023将上式进一步简化为如下所示的矩阵形式：将上式进一步简化为如下所示的矩阵形式：上式也称为机器人的动力学模型。上式也称为机器人的动力学模型。式中：式中：是机器人动力学模型中的惯性力项，是机器人动力学模型中的惯性力项，表示机器人操作机的质量矩阵，它是表示机器人操作机的质量矩阵，它是nn阶阶的对称矩阵，。的对称矩阵，。是是n1阶矩阵，表示机器人动力学模型中阶矩阵，表示机器人动力学模型中非线性的耦合力项，包括离心力（自耦力）和哥氏非线性的耦合力项，包括离心力（自耦力）和哥氏力（互耦力）。力（互耦力）。也是也是n1阶矩阵，表示机器人动力学模型中阶矩阵，表示机器人动力学模型

12、中的重力项。的重力项。第16页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 20231 1、牛顿、牛顿欧拉方程欧拉方程2 2、递推计算公式、递推计算公式3 3、递推算法应用、递推算法应用第17页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 2023牛顿牛顿欧拉方程原理欧拉方程原理：将机器人的每个杆件看成：将机器人的每个杆件看成刚体，并确定每个杆件质心的位置和表征其质量分刚体，并确定每个杆件质心的位置和表征其质量分布的惯性张量矩阵。当确定机器人坐标系后，根据布的惯性张量矩阵。当确定机器人坐标系后，根据机器人关节速度和

13、加速度，则可先由机器人机座开机器人关节速度和加速度，则可先由机器人机座开始向手部杆件始向手部杆件正向递推正向递推出每个杆件在自身坐标系中出每个杆件在自身坐标系中的速度和加速度，再用牛顿的速度和加速度，再用牛顿欧拉方程得到机器欧拉方程得到机器人每个杆件上的惯性力和惯性力矩，然后再由机器人每个杆件上的惯性力和惯性力矩，然后再由机器人末端关节开始向第一个关节人末端关节开始向第一个关节反向递推反向递推出机器人每出机器人每个关节上承受的力和力矩，最终得到机器人每个关个关节上承受的力和力矩，最终得到机器人每个关节所需要的驱动力（矩），这样就确定了机器人关节所需要的驱动力（矩），这样就确定了机器人关节的驱动

14、力（矩）与关节位移、速度和加速度之间节的驱动力（矩）与关节位移、速度和加速度之间的函数关系，即建立了机器人的动力学方程。的函数关系，即建立了机器人的动力学方程。第18页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 2023牛顿牛顿欧拉方程递推过程欧拉方程递推过程：正向递推正向递推：已知机器人各个关节的速度和加速度：已知机器人各个关节的速度和加速度从从1n递推出机器人每个杆件在自身坐标系中的速递推出机器人每个杆件在自身坐标系中的速度和加速度度和加速度机器人每个杆件质心上的速度和加速度机器人每个杆件质心上的速度和加速度再用牛顿再用牛顿欧拉方程得到机器人每个杆

15、件质心上欧拉方程得到机器人每个杆件质心上的惯性力和惯性力矩。的惯性力和惯性力矩。反向递推反向递推：根据正向递推的结果：根据正向递推的结果从从n1递推出机器递推出机器人每个关节上承受的力和力矩人每个关节上承受的力和力矩得到机器人每个关节得到机器人每个关节所需要的驱动力（矩）。所需要的驱动力（矩）。第19页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 20231 1、牛顿、牛顿欧拉方程欧拉方程（1 1）牛顿方程）牛顿方程惯性力惯性力 矢量。矢量。质心上的线加速度。质心上的线加速度。第20页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月

16、二月 2023 20231 1、牛顿、牛顿欧拉方程欧拉方程（2 2）欧拉方程）欧拉方程惯性力矩惯性力矩 矢量。矢量。质心上的惯性张量矩阵。质心上的惯性张量矩阵。第21页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 20231 1、牛顿、牛顿欧拉方程欧拉方程（2 2）欧拉方程）欧拉方程惯性力矩惯性力矩惯性张量矩阵：惯性张量矩阵：a.a.坐标系：与杆件坐标系同向，位于杆件质心上。坐标系：与杆件坐标系同向，位于杆件质心上。b.b.元素名称：元素名称：Icxx，Icyy，Iczz惯性矩；惯性矩；Icxy=Icyx,Icyz=Iczy,Iczx=Icxz惯性积。惯

17、性积。第22页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 20231 1、牛顿、牛顿欧拉方程欧拉方程（2 2）欧拉方程）欧拉方程惯性力矩惯性力矩惯性张量矩阵：惯性张量矩阵：理论计算方法：理论计算方法：实验测试法：实验测试法：惯量摆仪器。惯量摆仪器。第23页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 20232 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：已知机器人各个关节的速度和加速度：已知机器人各个关节的速度和加速度：从从1n递推出机器人每个杆件在自身坐标系中的递推出机器人每个杆件在自身坐标系

18、中的速度和加速度；速度和加速度；机器人每个杆件质心上的速度和加速度；机器人每个杆件质心上的速度和加速度；机器人每个杆件质心上的惯性力和惯性力矩。机器人每个杆件质心上的惯性力和惯性力矩。第24页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 20232 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：以第一种杆件坐标系为例以第一种杆件坐标系为例杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式建立相邻两个杆件的坐标系：建立相邻两个杆件的坐标系：i-1i-1、i i。Oiii-1关节关节iXi-1Z i-1Oi-1XiZi第25页/共79页4

19、.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式已知：已知：i i关节速度和加速度关节速度和加速度 i-1i-1杆件速度和加速度杆件速度和加速度计算：计算：i i杆件速度和杆件速度和 加速度加速度17 17 二月二月 2023 2023ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第26页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式分析：分析：

20、I I、坐标系、坐标系:相邻杆件位姿矩阵相邻杆件位姿矩阵IIII、关节速度和加速度、关节速度和加速度 的矢量化：的矢量化：17 17 二月二月 2023 2023ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第27页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式17 17 二月二月 2023 2023ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第28页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1

21、）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式17 17 二月二月 2023 2023ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第29页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式17 17 二月二月 2023 2023关节关节iii-1Xi-1Z i-1Oi-1XiZiOi第30页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件质心上的速度和加速

22、度杆件质心上的速度和加速度17 17 二月二月 2023 2023iXiZiOi第31页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件质心上的惯性力和惯性力矩杆件质心上的惯性力和惯性力矩惯性力惯性力：惯性力矩惯性力矩：17 17 二月二月 2023 2023iXiZiOi第32页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 20232 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：以第二种杆件坐标系为例以第二种杆件坐标系为例杆件速度和加速度递推计算公式杆件速度和加速

23、度递推计算公式建立相邻两个杆件的坐标系：建立相邻两个杆件的坐标系：i-1i-1、i i。ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第33页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式已知：已知：i i关节速度和加速度关节速度和加速度 i-1i-1杆件速度和加速度杆件速度和加速度计算：计算：i i杆件速度和加速度杆件速度和加速度17 17 二月二月 2023 2023ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第34页/共79页4.2 4.2

24、 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式分析：分析：I I、坐标系、坐标系:相邻杆件位姿矩阵相邻杆件位姿矩阵IIII、关节速度和加速度、关节速度和加速度 的矢量化：的矢量化：17 17 二月二月 2023 2023ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第35页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式17 17 二月二月 2023 202

25、3ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第36页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件速度和加速度递推计算公式杆件速度和加速度递推计算公式17 17 二月二月 2023 2023ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第37页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件质心上的速度和加速度杆件质心上的速度和加速度17 17 二月二月 2023 2023iXiZiOi第38页/共79页4.2 4.2 牛

26、顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（1 1）正向递推）正向递推：杆件质心上的惯性力和惯性力矩杆件质心上的惯性力和惯性力矩惯性力惯性力：惯性力矩惯性力矩：17 17 二月二月 2023 2023iXiZiOi第39页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 20232 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：已知机器人各个杆件的惯性力和惯性力矩：已知机器人各个杆件的惯性力和惯性力矩：从从n1递推出机器人每个关节承受的力和力矩；递推出机器人每个关节承受的力和力矩；机器人每个关节的驱动力或驱动力矩。机器人每个关

27、节的驱动力或驱动力矩。第40页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法17 17 二月二月 2023 20232 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：以第二种杆件坐标系为例以第二种杆件坐标系为例关节承受的力和力矩关节承受的力和力矩 递推计算公式递推计算公式 建立相邻两个杆件的建立相邻两个杆件的坐标系：坐标系：i-1i-1、iiii-1关节关节iXi-1Z i-1Oi-1XiZiOi第41页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节承受的力和力矩关节承受的力和力矩 递推计算公式递

28、推计算公式已知：已知：i-1i-1杆件的惯性力杆件的惯性力 和惯性力矩和惯性力矩 i i关节承受的力和力矩关节承受的力和力矩计算：计算：i-1i-1关节承受的力和关节承受的力和 力矩力矩17 17 二月二月 2023 2023ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第42页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节承受的力和力矩关节承受的力和力矩 递推计算公式递推计算公式分析：分析：I I、坐标系、坐标系:相邻杆件位姿矩阵相邻杆件位姿矩阵IIII、i-1i-1杆件受力分析：杆件受力分析：17 17

29、二月二月 2023 2023ii-1关节关节iXi-1Z i-1Oi-1XiZiOi第43页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节承受的力和力矩关节承受的力和力矩 递推计算公式递推计算公式以以i-1i-1杆件为研究对象，杆件为研究对象，由达朗贝尔原理可得：由达朗贝尔原理可得：17 17 二月二月 2023 2023i-1关节关节iXi-1Z i-1Oi-1Oi第44页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节承受的力和力矩关节承受的

30、力和力矩 递推计算公式递推计算公式以以i-1i-1杆件为研究对象，杆件为研究对象，由达朗贝尔原理可得：由达朗贝尔原理可得：17 17 二月二月 2023 2023i-1关节关节iXi-1Z i-1Oi-1Oi第45页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法2 2、递推计算公式、递推计算公式（2 2）反向递推）反向递推：关节驱动力（矩）关节驱动力（矩）平移关节：平移关节：回转关节：回转关节：则关节驱动力（矩）为：则关节驱动力（矩）为：17 17 二月二月 2023 2023i-1关节关节iXi-1Z i-1Oi-1第46页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3

31、、递推算法应用、递推算法应用（1 1）递推初始条件）递推初始条件正向递推正向递推机座机座0 0的速度和加速度：的速度和加速度：*考虑杆件自重或手部负载为重物时：考虑杆件自重或手部负载为重物时：为描述在机座坐标系为描述在机座坐标系00中的标准重力加速中的标准重力加速度。度。17 17 二月二月 2023 2023gx0z0o0第47页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用（1 1）递推初始条件）递推初始条件反向递推反向递推机器人手部负载：机器人手部负载：17 17 二月二月 2023 2023第48页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧

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

33、方程法3 3、递推算法应用、递推算法应用（2 2）递推应用条件）递推应用条件第二种坐标系下递推算法第二种坐标系下递推算法正向递推正向递推:17 17 二月二月 2023 2023第50页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用（2 2）递推应用条件）递推应用条件第二种坐标系下递推算法第二种坐标系下递推算法反向递推反向递推:17 17 二月二月 2023 2023第51页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用例：已知二自由度机器人如例：已知二自由度机器人如图所示，机器人两个杆件的图所示，机器人两个杆

34、件的长度分别为长度分别为 和和 ，且其质，且其质量量 和和 都集中在杆件的端都集中在杆件的端头。若用第二种方法建立机头。若用第二种方法建立机器人的坐标系，当机器人各器人的坐标系，当机器人各个关节的位移个关节的位移 、速度、速度 和加速度和加速度 已知时，试用已知时，试用牛顿牛顿欧拉递推算法计算欧拉递推算法计算各关节的驱动力矩。各关节的驱动力矩。17 17 二月二月 2023 202312m1m2xy关节关节1 1关节关节2 2第52页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：建立坐标系如图所示。解：建立坐标系如图所示。相邻杆件的位姿矩阵为：相邻

35、杆件的位姿矩阵为：17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2第53页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推已知关节速度和加速度分别已知关节速度和加速度分别为为 ，由于考虑杆，由于考虑杆件的重量，所以机座的运动件的重量，所以机座的运动参数（初始条件）设为：参数（初始条件）设为：17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第54页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、

36、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第55页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第56页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关

37、节关节1 1关节关节2 2x1x2y1y2g第57页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第58页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第59页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应

38、用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第60页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第61页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1

39、1关节关节2 2x1x2y1y2g第62页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第63页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第64页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算

40、法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第65页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(1)(1)正向递推正向递推17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第66页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推 由于机器人手部无负载，由于机器人手部无负载，所以初始条件为：所以初始条件为：17

41、 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第67页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节2 2受的力和力矩：受的力和力矩：17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第68页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节2 2受的力和力矩：受的力和力矩：17 17 二月二月 2023 202312

42、m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第69页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节2 2的驱动力矩：的驱动力矩：17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第70页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1受的力和力矩：受的力和力矩：17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2

43、x1x2y1y2g第71页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1受的力和力矩：受的力和力矩：17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第72页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1受的力和力矩：受的力和力矩：17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第73页/共79页4.

44、2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1的驱动力矩：的驱动力矩：17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第74页/共79页4.2 4.2 牛顿牛顿欧拉方程法欧拉方程法3 3、递推算法应用、递推算法应用解：解：(2)(2)反向递推反向递推关节关节1 1和和2 2的驱动力矩为：的驱动力矩为：17 17 二月二月 2023 202312m1m2x0y0关节关节1 1关节关节2 2x1x2y1y2g第75页/共79页习习 题题1.1.机器人动力学解决什么

45、问题？什么是动力学正问机器人动力学解决什么问题？什么是动力学正问题和逆问题？题和逆问题？2.2.写出动力学模型，并简述各项的含义写出动力学模型，并简述各项的含义?3.3.什么是牛顿方程？什么是欧拉方程？有何作用？什么是牛顿方程？什么是欧拉方程？有何作用？4.4.什么是惯性张量矩阵？如何计算？什么是惯性张量矩阵？如何计算？5.5.正向递推的作用是什么正向递推的作用是什么?分哪几步实现？分哪几步实现？6.6.反向递推的作用是什么反向递推的作用是什么?分哪几步实现？分哪几步实现？7.7.正向递推和反向递推的初始条件各是什么？当考正向递推和反向递推的初始条件各是什么？当考虑杆件自重或手部负载为重物时，初始条件有何虑杆件自重或手部负载为重物时，初始条件有何变化？变化？17 17 二月二月 2023 2023第76页/共79页习习 题题17 17 二月二月 2023 2023400400m第77页/共79页第四章完！第四章完！第78页/共79页感谢您的观看！第79页/共79页