第3章节机器人动力学课件(4604KB).ppt

当连杆处于平衡状态时，力的平衡方程： 力矩平衡方程： 对于旋转关节i，若不考虑关节中的摩擦，则除了绕轴的扭矩之外，其余各方向 的力和力矩分量都由机构构件承受。为了保持连杆平衡，关节驱动力矩平衡力矩 的Z向分量应该等于 ： 3.3 机器人动力学方程 3.3.1牛顿—欧拉递推动力学方程 将机器人的连杆看成刚体，其质心加速度、总质量、角速度、角加速度、惯性 张量与作用力矩满足如下关系： 牛顿第二定律 （力平衡方程） 欧拉方程 （力矩平衡方程） 1 力和力矩的递推算式 连杆i在运动情况下，作用在上面的合力为零，得力平衡方程式（暂时不考虑重力）： 作用在连杆i上的合力矩等于零，得力矩平衡方程式： 将上式写成从末端连杆向内迭代的形式： 利用这些公式可以从末端连杆n开始，顺次向内递推直至到操作臂的基座。 对于旋转关节，各关节上所需的扭矩等于连杆作用在它相邻连杆的力矩的Z轴分量 2 递推的牛顿—欧拉动力学算法 综上所述，将递推计算过程的相关公式归纳如下： 3 计及重力的动力学算法 4 封闭形式动力学方程的建立 以2R机械手为例说明建立封闭形式的动力学方程的一般方法和步骤。 2R平面机械手的质量分布 3.3.2 关节空间与操作空间动力学 1 关节空间的状态方程 则 (3-99) 2 形位空间方程 将（3-99）式中与速度有关的项分成两部分： 因而动力学方程可以写成另一种形式： 3 操作空间动力学方程 两个空间中的位移关系： 两个空间中的速度关系： 两个空间中的加速度关系： 式中 在操作空间中，动力学方程式可以写成： 关节空间动力学方程与操作空间动力学方程具有以下关系： (3-108) 4 操作运动—关节力矩方程 操作运动—关节力矩之间的动力学方程： 可以改写成如下的形式： 3.3.3 拉格朗日方程的应用 以R—P机械手为例，说明采用拉格朗日方程建立机器人动力学方程的方法。 将动力学方程写成更加一般的形式(将关节θ称关节l，关节r称关节2) 3.3.4 多足步行机器人的动力学模型 其中 1 完整约束方程 2 关节空间运动变换 系统运动学约束关系为： 方程的秩为： 以拉格朗日乘子矢量函数形式的广义约束力矢量为： 3 多足步行机器人的动力学模型 4 机器人脚力问题 其中 A 关节驱动的约束分析 B 摩擦及有效接触的约束分析 实际步行时机器人的脚底作用力必须满足相关物理约束条件：关节驱动约束及摩擦约束。 * 机器人引论 第3章 机器人动力学 第3章 机器人动力学 3.1 动力学分析基础 3.2 机器人的静力分析 3.3 机器人动力学方程 3.1 动力学分析基础 3.1.1 机器人的坐标系 图3-1 机器人的坐标系 3.1.2 工具的定位 (3-1) 方程（3-1）在某些机器人系统中称为WHERE函数，用它可计算手臂的位置。对于图3-1中情况，WHERE的输出是轴销相对于工作台顶角处的位姿。 3.1.3 惯性张量和惯性矩阵 绕轴x、y和z的质量惯性矩分别为 混合矩(称为惯性积)： 3.1.4 连杆运动的传递 加速度： 速度： 简化为： 简化为： 微分得： 下面利用Denavit-Hartenberg的连杆参数表示方法，依次递推出机器人操作臂或者步行机器人运动腿各连杆的速度和加速度。 相邻两连杆速度的传递 1 旋转关节的速度传递 2 移动关节的速度传递 3 旋转关节的加速度传递 4 移动关节加速度的传递 5 质心的加速度 3.1.5 牛顿—欧拉动力学方程 刚体的运动可以分解为刚体质心的移动和刚体绕质心的转动。应用牛顿-欧拉方程来建立机器人机构的动力学方程，是指相对质心的移动用牛顿方程，相对于质心的转动用欧拉方程。 在移动和转动的刚体S上任选固定 在刚体上的一点O，将基准坐标系 的 原点移至点O上成为随行坐标系 ，随 行坐标系 随S移动，但不随S转动， 以便观察S相对坐标系 的转动运动。 根据动量矩定理推出： （I为刚体的惯性张量） 3.1.6 拉格朗日方程 3.2 机器人的静力分析 3.2.1 等效关节力和力雅可比 称为终端广义力矢量 将各个关节驱动力(或力矩)组成的n维矢量，称为关节力(矩)矢量。 若将关节力(矩)矢量看成是驱动装置的输入，在末端产生的广义力作为输出， 可以建立两者之间的关系。 各关节所作的虚功之和为： 末端操作器所作的虚功为： 关节空间虚位移产生的虚功等于操作空间虚位移产生的虚功： 整理有： 若不考虑关节之间的摩擦力，在外力F的作用下，操作臂或者运动腿保持平衡 的条件是关节驱动力矩满足上式 我们将雅可比矩阵写成如下型式： (3-68) 3.2.2 连杆的静力学分析 连杆的静力平衡 *