1、机器人引论 第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的连杆参数表示方法 依次递推出机器人操作臂或者
2、步行机器人运动腿各连杆的速度和加速度 相邻两连杆速度的传递 1旋转关节的速度传递2移动关节的速度传递 3旋转关节的加速度传递4移动关节加速度的传递 5质心的加速度 3 1 5牛顿 欧拉动力学方程刚体的运动可以分解为刚体质心的移动和刚体绕质心的转动 应用牛顿 欧拉方程来建立机器人机构的动力学方程 是指相对质心的移动用牛顿方程 相对于质心的转动用欧拉方程 在移动和转动的刚体S上任选固定在刚体上的一点O 将基准坐标系的原点移至点O上成为随行坐标系 随行坐标系随S移动 但不随S转动 以便观察S相对坐标系的转动运动 根据动量矩定理推出 I为刚体的惯性张量 3 1 6拉格朗日方程 3 2机器人的静力分析
3、3 2 1等效关节力和力雅可比 称为终端广义力矢量 将各个关节驱动力 或力矩 组成的n维矢量 称为关节力 矩 矢量 若将关节力 矩 矢量看成是驱动装置的输入 在末端产生的广义力作为输出 可以建立两者之间的关系 各关节所作的虚功之和为 末端操作器所作的虚功为 关节空间虚位移产生的虚功等于操作空间虚位移产生的虚功 整理有 若不考虑关节之间的摩擦力 在外力F的作用下 操作臂或者运动腿保持平衡的条件是关节驱动力矩满足上式 我们将雅可比矩阵写成如下型式 3 68 3 2 2连杆的静力学分析 连杆的静力平衡 当连杆处于平衡状态时 力的平衡方程 力矩平衡方程 对于旋转关节i 若不考虑关节中的摩擦 则除了绕轴
4、的扭矩之外 其余各方向的力和力矩分量都由机构构件承受 为了保持连杆平衡 关节驱动力矩平衡力矩的Z向分量应该等于 3 3机器人动力学方程 3 3 1牛顿 欧拉递推动力学方程 将机器人的连杆看成刚体 其质心加速度 总质量 角速度 角加速度 惯性张量与作用力矩满足如下关系 牛顿第二定律 力平衡方程 欧拉方程 力矩平衡方程 1力和力矩的递推算式 连杆i在运动情况下 作用在上面的合力为零 得力平衡方程式 暂时不考虑重力 作用在连杆i上的合力矩等于零 得力矩平衡方程式 将上式写成从末端连杆向内迭代的形式 利用这些公式可以从末端连杆n开始 顺次向内递推直至到操作臂的基座 对于旋转关节 各关节上所需的扭矩等于
5、连杆作用在它相邻连杆的力矩的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摩擦及有效接触的约束分析 实际步行时机器人的脚底作用力必须满足相关物理约束条件 关节驱动约束及摩擦约束
