机器人动力学

1、机器人动力学DynamicsofRobotics,研究机器人的运动特性与力的关系。有两类问题：动力学正问题：已知机械手各关节的作用力或力矩，求各关节的位移、速度、加速度、运动轨迹；动力学逆问题：已知机械手的运动轨迹，即各关节的位移、速度和加速度，求各关节的驱动力和力矩。,机器人动力学DynamicsofRobotics,4.1机器人刚体动力学(复习加深理论力学内容)4.2机械手动力学方程(Lagrange法)4.3机械手动力学方程实例(二杆、三杆机械手)4.4机器人的动态特性4.5机械手的稳态负荷,Robotics动力学,4.1机器人刚体动力学4.1.0动力学基本定理绝对运动：相对于定坐标系的

2、运动相对运动：相对于动坐标系的运动牵连运动：动坐标相对于定坐标运动绝对运动方程：在定坐标系中的运动方程相对运动方程：在动坐标系中的运动方程牵连运动方程：动坐标系在定坐标系中的运动方程,Robotics动力学,4.1机器人刚体动力学4.1.0动力学基本定理绝对运动速度：在定坐标系中的运动速度相对运动速度：在动坐标系中的运动速度牵连运动速度：动坐标系在定坐标系中的运动速度绝对运动加速度：在定坐标系中的运动加速度相对运动加速度：在动坐标系中的运动加速度牵连运动加速度：动坐标系在定坐标系中的运动加速度当牵连速度为平动时，当牵连运动为定轴转动时，,Robotics动力学,4.1机器人刚体动力学4.1.0

3、动力学基本定理Lagrange方程T:系统动能；qi:广义坐标；Qi:对应于广义坐标的广义力当主动力为势力时，方程变为：L:Lagrange函数,Robotics动力学,4.1机器人刚体动力学4.1.0动力学基本定理当主动力中有非势力时：Qj:为非势的广义力当含有粘性阻尼时，方程变为：，：瑞利耗三散函数,Robotics动力学,4.1机器人刚体动力学4.1.0动力学基本定理例：图示为振动系统方程1。动能2。势能,Robotics动力学,4.1机器人刚体动力学4.1.0动力学基本定理3。耗散函数4。拉格朗日函数,Robotics动力学,4.1机器人刚体动力学4.1.0动力学基本定理对每个广义坐标

4、写出拉格朗日方程将上述结果代入，得下面将K、P、D、W等表示动能、势能、耗散函数、外力做的功,Robotics动力学,4.1机器人刚体动力学4.1.1机械手的动能与势能考虑重力时:当时,取为广义坐标，有,Robotics动力学,4.1机器人刚体动力学4.1.1机械手的动能与势能当，都为广义坐标，有从以上两个例子看出，求取动力学方程的关键是求出各能量函数K、P、D、W的广义坐标表达式。,Robotics动力学,4.1机器人刚体动力学4.1.1机械手的动能与势能两杆机器人如图。对连杆1：对连杆2：,Robotics动力学,4.1机器人刚体动力学4.1.1机械手的动能与势能二杆动能和势能分别为：,R

5、obotics动力学,4.1机器人刚体动力学4.1.2机械手动力学方程的求法系统的总动能和势能及拉格朗日函数分别为：分别求得注意：这里只求显因变量的偏导数,Robotics动力学,4.1机器人刚体动力学4.1.2机械手动力学方程的求法代入拉格朗日方程,Robotics动力学,4.1机器人刚体动力学4.1.2机械手动力学方程的求法写成矩阵有：惯性力向心力哥式力重力,Robotics动力学,4.1机器人刚体动力学4.1.2机械手动力学方程的求法当考虑关节摩擦阻尼时,Robotics动力学,4.1机器人刚体动力学4.1.2机械手动力学方程的求法当考虑关节摩擦阻尼时,Robotics动力学,4.2机械

6、手动力学方程本节将以右图为例，研究由A矩阵描述的机械手的动力学方程建立的一般步骤：1。计算任一连杆上任意一点的速度；2。计算各连杆的动能和机械手的总动能；3。计算各连杆的位能和机械手的总位能；4。建立机械手系统的拉格郎日函数；5。对拉格郎日函数求导，得到动力学方程。,Robotics动力学,4.2机械手动力学方程4.2.1速度的计算图中，连杆3上P点的位置为：0rp为基坐标系中P的位置矢量；3rp为杆3坐标系中P的位置矢量（原点O3）；T3杆3的位姿矩阵；（即P点在上述两坐标系中坐标之间的变换矩阵。）对任一连杆i上的一点，其位置为,Robotics动力学,4.2机械手动力学方程4.2.1速度的

7、计算所以，P点的速度为为何不对r求导？对任一连杆i上的一点，其速度为,Robotics动力学,4.2机械手动力学方程4.2.1速度的计算P点的加速度为对任一连杆i上的一点，其加速度为,Robotics动力学,4.2机械手动力学方程4.2.1速度的计算P点速度的平方为对任一连杆i上的一点，其速度平方为,Robotics动力学,4.2机械手动力学方程4.2.2动能和位能的计算杆3上P点质量为dm的微元，其动能为：对任一连杆i上的质量为dm点，其动能为,Robotics动力学,4.2机械手动力学方程4.2.2动能和位能的计算杆3的动能为：记，并称之为连杆3的伪惯量矩阵，则对任连杆i，其动能为,Rob

8、otics动力学,4.2机械手动力学方程4.2.2动能和位能的计算伪惯量矩阵I的一般形式为：,Robotics动力学,4.2机械手动力学方程4.2.2动能和位能的计算则具有n个连杆的机械手的连杆总动能为：考虑传动装置的惯量，所有传动装置的总动能为：系统的总动能为,Robotics动力学,4.2机械手动力学方程4.2.2动能和位能的计算位能：质量m,高h的物体，其位能为连杆i上位置的质量dm的微元，其位能为连杆i的总位能为,Robotics动力学,4.2机械手动力学方程4.2.2动能和位能的计算系统的总位能为式中，为连杆i的质量；为连杆i对其前端关节坐标系的重心位置。,Robotics动力学,4

9、.2机械手动力学方程4.2.3动力学方程的推导系统的拉格朗日函数为,Robotics动力学,4.2机械手动力学方程4.2.3动力学方程的推导,Robotics动力学,4.2机械手动力学方程4.2.3动力学方程的推导系统的动力学方程为,Robotics动力学,4.2机械手动力学方程4.2.3动力学方程的推导,Robotics动力学,4.2机械手动力学方程4.2.3动力学方程的简化1。惯量项的简化利用记微分旋转和平移为：通过计算有：为质心矢量，为与惯量相关的矩阵，具有如下形式。,Robotics动力学,4.2机械手动力学方程4.2.3动力学方程的简化1。惯量项的简化当i=j时，有,Robotics

10、动力学,4.2机械手动力学方程4.2.3动力学方程的简化2。重力项的简化将代入,Robotics动力学,4.3机械手动力学方程实例4.3.1二连杆机械手动力学方程,Robotics动力学,4.3机械手动力学方程实例4.3.1二连杆机械手动力学方程以为基准，有以为基准，有以为基准，有,Robotics动力学,4.3机械手动力学方程实例4.3.1二连杆机械手动力学方程设所有惯性力矩为零，为零。有此结果与4.1.2中的一致。,Robotics动力学,4.4机械手动态特性动态特性指：工作精度、重复能力、稳定性、空间分辨率4.4.1概述快速、准确、定位的能力；过块：精度差，（惯性影响）过慢：效率低对工业

11、机器人，采用中继点来减少惯性影响。,Robotics动力学,4.4机械手动态特性4.4.2稳定性稳定性指系统、装置或工具运动过程中，无振荡问题。对机械系统主要有系统的自激振动；对电子系统，主要指其自激振荡；对机器人系统，除上述两者外，还有其机电耦合振荡。如机械手的抖动。,Robotics动力学,4.4机械手动态特性4.4.3空间分辨率空间分辨率是描述机器人工具末端运动所达到的最小运动增量。,Robotics动力学,4.4机械手动态特性4.4.4精度用下列三个因素的集合来描述精度1）各控制部件的分辨率；2）各机械部件的偏差；3）最近到达点距目标位置的差；,Robotics动力学,4.4机械手动态

12、特性4.4.4精度示教时，精度只与机械偏差有关；离线编程时，与分辨率、机械偏差、接近能力有关。,Robotics动力学,4.4机械手动态特性4.4.5重复性指机器人重复到达某一位置的能力。,Robotics动力学,4.4机械手动态特性4.4.5重复性指机器人重复到达某一位置的能力。几个概念的区别：1）空间分辨率描述机器人所能控制的末端工具的最小运动增量2）精度指一定分辨率下，机器人对某目标的接近能力；3）重复性描述机器人重复到达同一目标时实际的位置误差；4）一般重复性比精度好。,Robotics动力学,4.5机械手的静态负荷解决：1。静力和力矩的表示方法；2。不同坐标系间，静负荷的变换；3。确定机械手静态关节力矩；4。由关节力矩确定机械手所载物体的重量。,Robotics动力学,4.5机械手的静态负荷4.5.1静力和力矩的表示方法广义力F例：,Robotics动力学,4.5机械手的静态负荷4.5.2不同坐标系间静力的变换采用虚位移原理，研究静力作用在不同坐标系中的描述问题。已知：在A坐标系中的作用力表示为：表示虚位移的微分运动矢量为：已知C坐标系到A坐标系的坐标变换；求：在C坐标系中的作用力CF。F所做虚功为：在C坐标系中做的虚功为：,Robotics动力学,4.5机械手的静态负荷4.5.2不同坐标系间静力的变换即：由微分变换的等价关