资源描述
机器人动力学 Dynamics of Robotics,研究机器人的运动特性与力的关系。 有两类问题： 动力学正问题：已知机械手各关节的作用力或力矩，求各关节的位移、速度、加速度、运动轨迹； 动力学逆问题：已知机械手的运动轨迹，即各关节的位移、速度和加速度，求各关节的驱动力和力矩。,机器人动力学 Dynamics of Robotics,4.1 机器人刚体动力学 (复习加深理论力学内容) 4.2 机械手动力学方程 (Lagrange法) 4.3 机械手动力学方程实例 (二杆、三杆机械手) 4.4 机器人的动态特性 4.5 机械手的稳态负荷,Robotics 动力学,4.1 机器人刚体动力学 4.1.0 动力学基本定理 绝对运动：相对于定坐标系的运动 相对运动：相对于动坐标系的运动 牵连运动：动坐标相对于定坐标运动 绝对运动方程：在定坐标系中的运动方程 相对运动方程：在动坐标系中的运动方程 牵连运动方程：动坐标系在定坐标系中的运动方程,Robotics 动力学,4.1 机器人刚体动力学 4.1.0 动力学基本定理 绝对运动速度：在定坐标系中的运动速度 相对运动速度：在动坐标系中的运动速度 牵连运动速度：动坐标系在定坐标系中的运动速度 绝对运动加速度：在定坐标系中的运动加速度 相对运动加速度：在动坐标系中的运动加速度 牵连运动加速度：动坐标系在定坐标系中的运动加速度 当牵连速度为平动时， 当牵连运动为定轴转动时，,Robotics 动力学,4.1 机器人刚体动力学 4.1.0 动力学基本定理 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 动力学基本定理 对每个广义坐标写出拉格朗日方程 将上述结果代入，得 下面将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 机械手的动能与势能 二杆动能和势能分别为：,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.1 机器人刚体动力学 4.1.2 机械手动力学方程的求法 当考虑关节摩擦阻尼时,Robotics 动力学,4.2 机械手动力学方程 本节将以右图为例，研究由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 速度的计算 所以，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，其动能为,Robotics 动力学,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.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 动力学,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 概述 快速、准确、定位的能力； 过块：精度差，（惯性影响） 过慢：效率低 对工业机器人，采用中继点来减少惯性影响。,Robotics 动力学,4.4 机械手动态特性 4.4.2 稳定性 稳定性指系统、装置或工具运动过程中，无振荡问题。 对机械系统主要有系统的自激振动； 对电子系统，主要指其自激振荡； 对机器人系统，除上述两者外，还有其机电耦合振荡。如机械手的抖动。,Robotics 动力学,4.4 机械手动态特性 4.4.3 空间分辨率 空间分辨率是描述机器人工具末端运动所达到的最小运动增量。,Robotics 动力学,4.4 机械手动态特性 4.4.4 精度 用下列三个因素的集合来描述精度 1）各控制部件的分辨率； 2）各机械部件的偏差； 3）最近到达点距目标位置的差；,Robotics 动力学,4.4 机械手动态特性 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 不同坐标系间静力的变换 即： 由微分变换的等价关系式（3-97），有 或记为：,Robotics 动力学,4.5 机械手的静态负荷 4.5.2 不同坐标系间静力的变换 从而有 经变换有,Robotics 动力学,4.5 机械手的静态负荷 4.5.3 关节力矩的确定 设作用于作用于机器人末端T6杆上的力所做的虚功 各关节力/力矩所做的虚功， ：广义力矩矢量（旋转、平移）； dq:表示虚位移的微分变换。 两者相等： 由（3-111） 得,Robotics 动力学,习题： P142， 第4.1题,
展开阅读全文