一种3D欠驱动双足机器人的动力学模型计算方法

摘要

本发明涉及机器人技术领域，提供了一种3D欠驱动双足机器人的动力学模型计算方法，该方法针对3D欠驱动双足机器人，对其在单足支撑相与双足支撑相都进行了动力学模型计算；其中，机器人的双足支撑相由碰撞过程以及坐标切换过程组成。相比于以往的动力学模型计算方法，本发明所提出的动力学模型计算方法使得3D欠驱动双足机器人动力学模型的编程计算过程变得简单清晰，从而便于编程应用。

主权项

一种3D欠驱动双足机器人的动力学模型计算方法，其特征在于，包括以下步骤：步骤一，基于DH方法，建立机器人的关节坐标系q＝(q₁,q₂,q₃,q₄,q₅,q₆,q₇,q₈)，并求出坐标系q_k在坐标系q_k‑1下的齐次转换矩阵其中k＝1,2，..8；步骤二，假设机器人各杆件的质量集中于质心，基于DH方法，求得各质心在世界坐标系下的位置向量p_i以及速度向量v_i；进而求得机器人系统的总的动能E和势能P：其中，m_i表示第i个杆件的质量，i＝1,2,…5；p_i(3)表示向量p_i的第三个元素；步骤三，计算双足机器人在单足支撑相的动力学模型，其中D为惯性质量矩阵，H为耦合矩阵，B为常数矩阵，u＝[u₃,u₄,u₅,u₆,u₇,u₈]′为主动关节驱动力矩；步骤四，计算双足机器人与地面碰撞的动力学模型，其中，D_e表示增广的惯性质量矩阵，与表示机器人碰撞前后的广义角速度,F₂表示地面对摆动腿在接触点的反作用力，表示摆动腿的位置及其方向角对广义坐标系q_e的雅可比矩阵；步骤五，计算机器人的坐标切换模型，其中，主动关节的切换模型为 [q₃,q₄,q₅,q₆,q₇,q₈]→[q₈,q₇,q₆,q₅,q₄,q₃]，欠驱动关节的切换模型为[q₁,q₂]→[q_1sw,q_2sw]，q_1sw表示摆动腿俯仰角，q_2sw表示摆动腿滚动角。