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