《第三章典型机械系统的建模PPT讲稿.ppt》由会员分享，可在线阅读，更多相关《第三章典型机械系统的建模PPT讲稿.ppt（52页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、第三章典型机械系统的建模第1页，共52页，编辑于2022年，星期二3.1 3.1 基于力学理论的机械系统建模基于力学理论的机械系统建模一、空间任意力系的平衡方程一、空间任意力系的平衡方程 由理论力学可知，空间任意力系平衡的必要和充分条件是：力由理论力学可知，空间任意力系平衡的必要和充分条件是：力系中所有各力在三坐标轴中每一轴上的投影和分别等于零，又这些系中所有各力在三坐标轴中每一轴上的投影和分别等于零，又这些力对于这些轴的力矩的代数和也分别等于零。其数学表达式为：力对于这些轴的力矩的代数和也分别等于零。其数学表达式为：第2页，共52页，编辑于2022年，星期二二、牛顿第二定律数学表达式二、牛顿
2、第二定律数学表达式 牛顿第二定律告诉我们，物体受外力作用时，所获得的加速度大小与合牛顿第二定律告诉我们，物体受外力作用时，所获得的加速度大小与合力大小成正比，与物体的质量成反比，加速度的方向与合外力的方向相同。力大小成正比，与物体的质量成反比，加速度的方向与合外力的方向相同。其数学表达式为：其数学表达式为：第3页，共52页，编辑于2022年，星期二例例 3.1 1 测量转动惯量实验装置测量转动惯量实验装置 如右图一个转动物体，它的质量为如右图一个转动物体，它的质量为m,由两根垂直的绳索（无弹性）挂起，每根绳索的长度为由两根垂直的绳索（无弹性）挂起，每根绳索的长度为h，绳索相距为，绳索相距为2a
3、。重心位于通过连接绳索两点的中点的垂线上，假设物体绕通过重心的。重心位于通过连接绳索两点的中点的垂线上，假设物体绕通过重心的垂直轴转一个小的角度，然后释放。求摆动周期垂直轴转一个小的角度，然后释放。求摆动周期T，物体通过重心的垂直，物体通过重心的垂直轴转的转动惯量轴转的转动惯量J。假设物体绕通过重心的垂直轴转一个假设物体绕通过重心的垂直轴转一个小的角度小的角度 时，夹角时，夹角 和夹角和夹角 间存在下列间存在下列关系关系因此因此注意，每根绳索的受力注意，每根绳索的受力F 的垂直分量的垂直分量等于等于mg/2。F 的水平分量为的水平分量为 mg /2。两根绳索的两根绳索的F 的水平分量产生扭矩的
4、水平分量产生扭矩mg a 使物体转动。因此，摆动的运动使物体转动。因此，摆动的运动方程为：方程为：第4页，共52页，编辑于2022年，星期二或写成或写成由此求得摆动周期为由此求得摆动周期为得到转动惯量得到转动惯量J第5页，共52页，编辑于2022年，星期二例例3.23.2 单摆系统单摆系统 下图所示的单摆系统下图所示的单摆系统 为输入力矩、为输入力矩、为输出摆角、为输出摆角、m为小球质量、为小球质量、L为摆长。为摆长。根据力系平衡建立系统方程：根据力系平衡建立系统方程：这是一个非线性方程，根据这是一个非线性方程，根据Taylor级数展级数展开得：开得：当当 很小时，高阶小数可以忽略，很小时，高
5、阶小数可以忽略，则：则：非线性系统方程可简化成线性系统方程非线性系统方程可简化成线性系统方程第6页，共52页，编辑于2022年，星期二例例3.3 设一个弹簧、质量、阻尼系统安装在设一个弹簧、质量、阻尼系统安装在一个不计质量的小车上，如下图所示。推导一个不计质量的小车上，如下图所示。推导系统数学模型。系统数学模型。假设假设t m,旋转角旋转角足够小，于是可以对运动方程做线性足够小，于是可以对运动方程做线性近似处理。这样，系统水平方向受力之和将为：近似处理。这样，系统水平方向受力之和将为：其中，其中，u(t)等于施加在小车上的外力，等于施加在小车上的外力，l 是质量到铰接点的是质量到铰接点的距离。
6、铰接点处的转矩之和为：距离。铰接点处的转矩之和为：选定两个选定两个2 阶系统的状态变量为：阶系统的状态变量为：将将a、b两式写成状态变量的形式，可得：两式写成状态变量的形式，可得：(a)(b)(c)(d)第13页，共52页，编辑于2022年，星期二 为得到为得到1阶微分方程组，解出式阶微分方程组，解出式（d）中的中的 ,代入式（代入式（c c），），并注意到并注意到M m，则有：，则有：(e)再解出式（再解出式（c）中的）中的 ，并代入式（，并代入式（d），可得：），可得：于是，于是，4 4个个1 1阶微分方程为：阶微分方程为：第14页，共52页，编辑于2022年，星期二 系统状态方程则为：系
7、统状态方程则为：第15页，共52页，编辑于2022年，星期二3.2 能量法推导运动方程能量法推导运动方程一、功、能、功率一、功、能、功率 如果力被认为是努力的度量，那么功就是成就的度量，而能量就是做功如果力被认为是努力的度量，那么功就是成就的度量，而能量就是做功的能力。功的概念没有考虑时间的因素，就要引入功率的概念。的能力。功的概念没有考虑时间的因素，就要引入功率的概念。功功 机械系统中的功等于力与力作用的距离的乘积（或力矩与角位移的乘机械系统中的功等于力与力作用的距离的乘积（或力矩与角位移的乘积），力与距离要在同一方向上度量。积），力与距离要在同一方向上度量。设力设力 F 作用于作用于 a
8、至至 b 连接路径中运动的质点连接路径中运动的质点 m 上，那么上，那么 F 所作的功所作的功可一般描述为可一般描述为 能量能量 一般情况下，能量可以定义为做功的能力。机械系统中能有一般情况下，能量可以定义为做功的能力。机械系统中能有势能势能和和动能动能两种形式。两种形式。功率功率是做功的速率，即：是做功的速率，即：dW 表示在表示在dt 时间间隔内所作的功。时间间隔内所作的功。第16页，共52页，编辑于2022年，星期二二、二、能量法推导运动方程能量法推导运动方程 能量法推导运动方程的根本就是能量法推导运动方程的根本就是能量守恒定律能量守恒定律。如果系统没有能。如果系统没有能量输入和输出，我
9、们从系统总能量保持相等这一事实出发来推导运动方量输入和输出，我们从系统总能量保持相等这一事实出发来推导运动方程。程。例例3.7 如右图表示一个半径为如右图表示一个半径为R、质量为、质量为m的均质圆柱体，它可以绕的均质圆柱体，它可以绕其转轴自由转动并通过一个弹簧与墙壁连接。假设圆柱体纯滚动而无滑动，其转轴自由转动并通过一个弹簧与墙壁连接。假设圆柱体纯滚动而无滑动，求系统的动能和势能并导出系统运动方程。求系统的动能和势能并导出系统运动方程。圆柱体的动能等于质心移动动能和绕质心转动的动能之和。圆柱体的动能等于质心移动动能和绕质心转动的动能之和。系统由于弹簧变形所产生的势能为系统由于弹簧变形所产生的势
10、能为 系统总能量为系统总能量为第17页，共52页，编辑于2022年，星期二 考虑到圆柱体做无滑动的滚动，因此，考虑到圆柱体做无滑动的滚动，因此，。并且注意到。并且注意到转动惯量转动惯量 J 等于等于 ，我们得到，我们得到 考虑到能量守恒定律，总能量为常数，即总能量导数为零，得考虑到能量守恒定律，总能量为常数，即总能量导数为零，得到到 注意到，注意到，并不总为并不总为0，因此，因此 必须恒等于必须恒等于0，即，即 如果将以上方程转为转动运动，只要把如果将以上方程转为转动运动，只要把 代入得到代入得到第18页，共52页，编辑于2022年，星期二3.3 拉格朗日方程（多自由度系统）拉格朗日方程（多自
11、由度系统）将将 作为作为n个自由度系统的一套广义坐标，系统的运动由个自由度系统的一套广义坐标，系统的运动由n个微分个微分方程表示，其中广义坐标是因变量，时间为自变量。方程表示，其中广义坐标是因变量，时间为自变量。令令 作为系统在任意瞬时的势能；作为系统在任意瞬时的势能；令令 作为系统在同瞬时的动能；作为系统在同瞬时的动能；拉格朗日函数拉格朗日函数 定义为定义为 设广义坐标是独立的，令设广义坐标是独立的，令 是广义坐标的变分，非保守力（外力是广义坐标的变分，非保守力（外力和摩擦力等）在广义坐标上的虚功可以写成和摩擦力等）在广义坐标上的虚功可以写成拉格朗日方程为拉格朗日方程为第19页，共52页，编
12、辑于2022年，星期二例例 3.83.8 例例3.4系统如图所示，运用拉格朗日方程建立该系统的系统如图所示，运用拉格朗日方程建立该系统的数学模型。数学模型。解解:选择选择y1，y2为广义坐标系，为广义坐标系，其系统动能和势能分别为其系统动能和势能分别为第20页，共52页，编辑于2022年，星期二第21页，共52页，编辑于2022年，星期二例例 3.9 某行星滚动机构中有一质量为某行星滚动机构中有一质量为m，半径为，半径为 r 的实心圆柱在半径为的实心圆柱在半径为R，质量为质量为M的圆筒内无滑动地滚动。已知圆柱和圆筒对轴心的圆筒内无滑动地滚动。已知圆柱和圆筒对轴心O的转动惯量分的转动惯量分别为别
13、为 ，圆柱对轴心，圆柱对轴心O的转动惯量为的转动惯量为 ,建立圆筒绕其轴心转建立圆筒绕其轴心转动时，该系统运动数学模型。动时，该系统运动数学模型。分析：该系统为两自由度系统。取广义坐标分别为圆筒转角分析：该系统为两自由度系统。取广义坐标分别为圆筒转角和圆柱轴和圆柱轴心偏离角心偏离角 。由于圆柱与圆筒间的运动是无滑动纯滚动，故在接触点由于圆柱与圆筒间的运动是无滑动纯滚动，故在接触点A处它处它们具有相同的线速度：们具有相同的线速度：。系统动能系统动能T为圆柱滚动和圆筒转动所具有的动能为圆柱滚动和圆筒转动所具有的动能第22页，共52页，编辑于2022年，星期二 系统的动力为重力，圆筒的势能等于零。系
14、统的动力为重力，圆筒的势能等于零。则系统的势能为则系统的势能为于是有拉格朗日函数于是有拉格朗日函数 代入拉格朗日方程有代入拉格朗日方程有 即为该行星滚动机构的运动数学模型。即为该行星滚动机构的运动数学模型。第23页，共52页，编辑于2022年，星期二例例 3.10 用拉格朗日方程建立图示系用拉格朗日方程建立图示系统运动的微分方程，用统运动的微分方程，用1、2和和x作为作为广义坐标，以矩阵的形式写出微分方程。广义坐标，以矩阵的形式写出微分方程。解：系统在任意时刻的动能为解：系统在任意时刻的动能为系统在同一时刻的势能为系统在同一时刻的势能为拉格朗日函数为拉格朗日函数为第24页，共52页，编辑于20
15、22年，星期二利用拉格朗日方程可得利用拉格朗日方程可得第25页，共52页，编辑于2022年，星期二3.4 3.4 机器人静力分析与动力学机器人静力分析与动力学 计算机技术的不断进步和发展使机器人技术的发展一次次达计算机技术的不断进步和发展使机器人技术的发展一次次达到一个新水平。上至太空舱、宇宙飞船，下至微机器人、深海开发，到一个新水平。上至太空舱、宇宙飞船，下至微机器人、深海开发，机器人技术已拓展到全球经济发展的诸多领域，成为高科技中极为机器人技术已拓展到全球经济发展的诸多领域，成为高科技中极为重要的组成部分。人类文明的发展、科技的进步已和机器人的研究、重要的组成部分。人类文明的发展、科技的进
16、步已和机器人的研究、应用产生了密不可分的关系。人类社会的发展已离不开机器人技术，应用产生了密不可分的关系。人类社会的发展已离不开机器人技术，而机器人技术的进步又对推动科技发展起着不可替代的作用。而机器人技术的进步又对推动科技发展起着不可替代的作用。第26页，共52页，编辑于2022年，星期二1818世纪瑞士世纪瑞士的写字偶人的写字偶人哈工大爬壁机器人哈工大爬壁机器人爬缆索机器人爬缆索机器人仿人机器人仿人机器人北航仿生鱼北航仿生鱼管管道道机机器器人人第27页，共52页，编辑于2022年，星期二 排雷机器人排雷机器人 “索杰纳索杰纳”火星车火星车 引导机器人引导机器人 工业机器人工业机器人第28页
17、，共52页，编辑于2022年，星期二 机器人，特别是其中最有代表性的关节型机器人，实机器人，特别是其中最有代表性的关节型机器人，实质上是由一系列关节连接而成的空间连杆开式链机构。要研质上是由一系列关节连接而成的空间连杆开式链机构。要研究机器人，就必须对其运动学和动力学有一个基本的了解。究机器人，就必须对其运动学和动力学有一个基本的了解。稳态下研究的机器人运动学分析只限于静态位置问题稳态下研究的机器人运动学分析只限于静态位置问题的讨论，未涉及机器人运动的力、速度、加速度等动态过程。的讨论，未涉及机器人运动的力、速度、加速度等动态过程。实际上，机器人是一个复杂的动力学系统，机器人系统在外实际上，机
18、器人是一个复杂的动力学系统，机器人系统在外载荷和关节驱动力矩载荷和关节驱动力矩(驱动力驱动力)的作用下将取得静力平衡，在的作用下将取得静力平衡，在关节驱动力矩关节驱动力矩(驱动力驱动力)的作用下将发生运动变化。机器人的的作用下将发生运动变化。机器人的动态性能不仅与运动学因素有关，还与机器人的结构形式、动态性能不仅与运动学因素有关，还与机器人的结构形式、质量分布、执行机构的位置、传动装置等对动力学产生重要质量分布、执行机构的位置、传动装置等对动力学产生重要影响的因素有关。影响的因素有关。第29页，共52页，编辑于2022年，星期二 机器人动力学主要研究机器人运动和受力之间的关系，机器人动力学主要
19、研究机器人运动和受力之间的关系，目的是对机器人进行控制、优化设计和仿真。机器人动力学目的是对机器人进行控制、优化设计和仿真。机器人动力学主要解决动力学正问题和逆问题两类问题：动力学正问题是主要解决动力学正问题和逆问题两类问题：动力学正问题是根据各关节的驱动力根据各关节的驱动力(或力矩或力矩)，求解机器人的运动，求解机器人的运动(关节位关节位移、速度和加速度移、速度和加速度)，主要用于机器人的仿真；动力学逆问，主要用于机器人的仿真；动力学逆问题是已知机器人关节的位移、速度和加速度，求解所需要的题是已知机器人关节的位移、速度和加速度，求解所需要的关节力关节力(或力矩或力矩)，是实时控制的需要。，是
20、实时控制的需要。本节首先通过实例介绍与机器人速度和静力有关的雅可本节首先通过实例介绍与机器人速度和静力有关的雅可比矩阵，在机器人雅可比矩阵分析的基础上进行机器人的静比矩阵，在机器人雅可比矩阵分析的基础上进行机器人的静力分析，讨论动力学的基本问题，对机器人的动态特性作简力分析，讨论动力学的基本问题，对机器人的动态特性作简要论述，以便为机器人编程、控制等打下基础。要论述，以便为机器人编程、控制等打下基础。第30页，共52页，编辑于2022年，星期二一、一、机器人雅可比矩阵机器人雅可比矩阵 机器人雅可比矩阵机器人雅可比矩阵(简称雅可比简称雅可比)揭示了操作空间与关节空间的揭示了操作空间与关节空间的映
21、射关系。雅可比不仅表示操作空间与关节空间的速度映射关系，映射关系。雅可比不仅表示操作空间与关节空间的速度映射关系，也表示二者之间力的传递关系，为确定机器人的静态关节力矩以及也表示二者之间力的传递关系，为确定机器人的静态关节力矩以及不同坐标系间速度、加速度和静力的变换提供了便捷的方法。不同坐标系间速度、加速度和静力的变换提供了便捷的方法。1 1、机器人雅可比的定义、机器人雅可比的定义 在机器人学中，雅可比是一个把关节速度向量在机器人学中，雅可比是一个把关节速度向量 变换为变换为手爪相对基坐标的广义速度向量手爪相对基坐标的广义速度向量v 的变换矩阵。在机器人速度的变换矩阵。在机器人速度分析和静力分
22、析中都将用到雅可比，现通过一个例子来说明：分析和静力分析中都将用到雅可比，现通过一个例子来说明：第31页，共52页，编辑于2022年，星期二 下下图为二自由度平面关节型机器人图为二自由度平面关节型机器人(2R(2R机器人机器人)，端点位置，端点位置X X、Y Y与关节与关节1 1、2 2的关系为：的关系为：即图图3.1 二自由度平面关节型机器人简图二自由度平面关节型机器人简图将其微分得即第32页，共52页，编辑于2022年，星期二令可将上式简写为 J 称为图示2R机器人的速度雅可比，它反映了关节空间微小运动d与手部作业空间微小位移dX 的关系。若对式 J 进行运算，则图示2R机器人的雅可比可写
23、为从从J 中元素的组成可见，中元素的组成可见，J 阵的值是关于阵的值是关于1 1及及2 2的函数。的函数。3.23.1第33页，共52页，编辑于2022年，星期二 推而广之，对于n自由度机器人，关节变量可用广义关节变量q表示，当关节为转动关节时 ；当关节为移动关节时 ，反映了关节空间的微小运动。机器人末端在操作空间的位置和方位可用末端手爪的位姿X表示，它是关节变量的函数，X=X(q)，并且是一个6维列矢量。反映了操作空间的微小运动，它由机器人末端微小线位移和微小角位移(微小转动)组成。因此，式3.1可写为：式中：J(q)是6n维偏导数矩阵，称为n自由度机器人速度雅可比，可表示为：3.3第34页
24、，共52页，编辑于2022年，星期二3.4第35页，共52页，编辑于2022年，星期二 2 2、机器人速度分析、机器人速度分析 利用机器人速度雅可比可对机器人进行速度分析。对式利用机器人速度雅可比可对机器人进行速度分析。对式(3.33.3)左、右两边各除以左、右两边各除以dt得得 3.53.6 式中：v为机器人末端在操作空间中的广义速度；为机器人关节在关节空间中的关节速度；J(q)为确定关节空间速度 与操作空间速度v 之间关系的雅可比矩阵。第36页，共52页，编辑于2022年，星期二式中：右边第一项表示仅由第一个关节运动引起的端点速度；右边第二项表示仅由第二个关节运动引起的端点速度；总的端点速
25、度为这两个速度矢量的合成。因此，机器人速度雅可比的每一列表示其他关节不动而某一关节运动产生的端点速度。对于图3.1所示2R机器人而言，J(q)是式(3.2)所示的22矩阵。若令J1，J2分别为式(3.2)所示雅可比的第1列矢量和第2列矢量，则式(3.6)可写为：第37页，共52页，编辑于2022年，星期二式中：J1称为机器人逆速度雅可比。图图3.13.1所示二自由度机器人手部的速度为：所示二自由度机器人手部的速度为：假如已知的 及 是时间的函数，即 ，则可求出该机器人手部在某一时刻的速度v=f(t)，即手部瞬时速度。反之，假如给定机器人手部速度，可由式(3.6)解出相应的关节速度为：3.7第3
26、8页，共52页，编辑于2022年，星期二例例 3.113.11 如图3.2所示的二自由度机械手，手部沿固定坐标系X0 轴正向以1.0m/s的速度移动，杆长l1=l2=0.5 m。设在某瞬时1=30，2=60，求相应瞬时的关节速度。图3.2 二自由度机械手手爪沿X0 方向运动示意图解解 由式由式(3.2)(3.2)知，二自由度机械手速度雅可比为知，二自由度机械手速度雅可比为第39页，共52页，编辑于2022年，星期二因此，逆雅可比为因此，逆雅可比为由式由式(3.7)(3.7)可知，可知，且，且，即，即vX=1m/s，vY=0，因此，因此第40页，共52页，编辑于2022年，星期二二、机器人动力学
27、方程二、机器人动力学方程 机器人动力学的研究有牛顿机器人动力学的研究有牛顿-欧拉法、拉格朗日法、高斯法、欧拉法、拉格朗日法、高斯法、凯恩法及罗伯逊凯恩法及罗伯逊-魏登堡法等。本节介绍动力学研究常用的牛魏登堡法等。本节介绍动力学研究常用的牛顿顿-欧拉方程和拉格朗日方程。欧拉方程和拉格朗日方程。1 1、欧拉方程欧拉方程 欧拉方程又称为牛顿欧拉方程又称为牛顿-欧拉方程，应用欧拉方程建立机器人欧拉方程，应用欧拉方程建立机器人机构的动力学方程是指：研究构件质心的运动使用牛顿方程，机构的动力学方程是指：研究构件质心的运动使用牛顿方程，研究相对于构件质心的转动使用欧拉方程。欧拉方程表征了力、研究相对于构件质
28、心的转动使用欧拉方程。欧拉方程表征了力、力矩、惯性张量和加速度之间的关系。力矩、惯性张量和加速度之间的关系。质量为m、质心在C点的刚体，作用在其质心的力F的大小与质心加速度aC 的关系为 式中：F、aC为三维矢量。式(2.21)称为牛顿方程。3.8第41页，共52页，编辑于2022年，星期二 欲使刚体得到角速度为、角加速度为的转动，则作用在刚体上力矩M的大小为 (3.93.9)式中：M、均为三维矢量；为刚体相对于原点通过质心C并与刚体固结的刚体坐标系的惯性张量。式(3.93.9)即为欧拉方程。在三维空间运动的任一刚体，其惯性张量可用质量惯性矩IXX、IYY、IZZ和惯性积IXY、IYZ、IZX
29、为元素的33阶矩阵或44阶齐次坐标矩阵来表示。通常将描述惯性张量的参考坐标系固定在刚体上，以方便刚体运动的分析。这种坐标系称为刚体坐标系(简称体坐标系)。第42页，共52页，编辑于2022年，星期二 2 2、拉格朗日方程拉格朗日方程 在机器人的动力学研究中，主要应用拉格朗日方程建立起在机器人的动力学研究中，主要应用拉格朗日方程建立起机器人的动力学方程。这类方程可直接表示为系统控制输入的函机器人的动力学方程。这类方程可直接表示为系统控制输入的函数，若采用齐次坐标，递推的拉格朗日方程也可建立比较方便而数，若采用齐次坐标，递推的拉格朗日方程也可建立比较方便而有效的动力学方程。有效的动力学方程。对于任
30、何机械系统，拉格朗日函数对于任何机械系统，拉格朗日函数L定义为系统总动能定义为系统总动能Ek与总势能与总势能Ep之差，即之差，即L=Ek Ep(3.10)由拉格朗日函数由拉格朗日函数L所描述的系统动力学状态的拉格朗日方所描述的系统动力学状态的拉格朗日方程为程为 (3.11)式中：式中：n为连杆数目；为连杆数目；qi 为系统选定的广义坐标，为系统选定的广义坐标，Fi为作用为作用在第在第i个坐标上的广义力或力矩个坐标上的广义力或力矩。第43页，共52页，编辑于2022年，星期二 3 3、平面关节机器人动力学分析平面关节机器人动力学分析 机器人是一个非线性的复杂动力学系统。动力学问题的机器人是一个非
31、线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，简化解的求解比较困难，而且需要较长的运算时间，因此，简化解的过程，最大限度地减少工业机器人动力学在线计算的时间是过程，最大限度地减少工业机器人动力学在线计算的时间是一个受到关注的研究课题。机器人动力学问题有两类：一个受到关注的研究课题。机器人动力学问题有两类：(1)(1)给出已知的轨迹点上的给出已知的轨迹点上的 、及及 ，即机器人关节位置、即机器人关节位置、速度和加速度，求相应的关节力矩向量速度和加速度，求相应的关节力矩向量。这对实现机器人动态。这对实现机器人动态控制是相当有用的。控制是相当有用的。(2)(2)已知关
32、节驱动力矩，求机器人系统相应的各瞬时的已知关节驱动力矩，求机器人系统相应的各瞬时的运动。也就是说，给出关节力矩向量运动。也就是说，给出关节力矩向量，求机器人所产生的，求机器人所产生的运动运动 、及及 ，这对机器人的运动模拟是非常有用的。这对机器人的运动模拟是非常有用的。第44页，共52页，编辑于2022年，星期二例例 3.123.12 以图以图3.33.3的的二自由度机器人二自由度机器人为例，推导机器人动力学方为例，推导机器人动力学方程程。图图3.3 3.3 二自由度机器人动力学方程的建立二自由度机器人动力学方程的建立第45页，共52页，编辑于2022年，星期二第第1 1步、选定广义关节变量及
33、广义力步、选定广义关节变量及广义力 选取笛卡儿坐标系。连杆选取笛卡儿坐标系。连杆1 1和连杆和连杆2 2的关节变量分别是转角的关节变量分别是转角1 1和和2 2，关节，关节1 1和关节和关节2 2相应的力矩是相应的力矩是1 1和和2 2。连杆。连杆1 1和连杆和连杆2 2的质量分别是的质量分别是m1和和m2，杆长分别为，杆长分别为l 1和和l 2，质心分别在，质心分别在k1和和k2处，处，离关节中心的距离分别为离关节中心的距离分别为p1和和p2。因此，杆因此，杆1 1质心质心k1的位置坐标为：的位置坐标为：杆杆1 1质心质心k1速度的平方为：速度的平方为：杆杆2 2质心质心k2的位置坐标为：的
34、位置坐标为：第46页，共52页，编辑于2022年，星期二杆杆2 2质心质心k2的速度为：的速度为：杆杆2 2质心质心k2速度的平方为：速度的平方为：第第2 2步步 系统动能系统动能 Ek第47页，共52页，编辑于2022年，星期二Ep1=m1gp1(1c1)Ep2=m2gl1(1c1)+m2gp2(1c12)第第3 3步步 系统势能系统势能Ep第第4 4步步 拉格朗日函数拉格朗日函数 根据拉格朗日方程计算各关节上的力矩，得到系统动力学根据拉格朗日方程计算各关节上的力矩，得到系统动力学方程。方程。第第5 5步步 系统动力学方程系统动力学方程第48页，共52页，编辑于2022年，星期二1)1)计算
35、关节计算关节1 1上的力矩上的力矩1 1 所以所以上式可简写为上式可简写为(3.12)第49页，共52页，编辑于2022年，星期二式式3.123.12中：中：(3.13)第50页，共52页，编辑于2022年，星期二2)2)计算关节计算关节2 2上的力矩上的力矩2 2 所以所以上式可简写为上式可简写为(3.14)第51页，共52页，编辑于2022年，星期二式式3.143.14中：中：(3.15)式式(3.12)(3.12)、式、式(3.13)(3.13)、式、式(3.14)(3.14)及式及式(3.15)(3.15)分别表示了关分别表示了关节驱动力矩与关节位移、速度、加速度之间的关系，即力和运动节驱动力矩与关节位移、速度、加速度之间的关系，即力和运动之间的关系，称为图之间的关系，称为图3.33.3所示二自由度机器人的动力学方程。所示二自由度机器人的动力学方程。第52页，共52页，编辑于2022年，星期二