CN105938364B - 一种3d欠驱动双足机器人的动力学模型计算方法 - Google Patents

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

Info

Publication number
CN105938364B
CN105938364B CN201610028460.4A CN201610028460A CN105938364B CN 105938364 B CN105938364 B CN 105938364B CN 201610028460 A CN201610028460 A CN 201610028460A CN 105938364 B CN105938364 B CN 105938364B
Authority
CN
China
Prior art keywords
robot
leg
under
coordinate system
kinetic model
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201610028460.4A
Other languages
English (en)
Other versions
CN105938364A (zh
Inventor
甘春标
袁海辉
杨世锡
施佳晨
刘浏
徐伟杰
许晓达
顾希雯
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang University ZJU
Original Assignee
Zhejiang University ZJU
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CN201610028460.4A priority Critical patent/CN105938364B/zh
Publication of CN105938364A publication Critical patent/CN105938364A/zh
Application granted granted Critical
Publication of CN105938364B publication Critical patent/CN105938364B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Evolutionary Computation (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Manipulator (AREA)

Abstract

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

Description

一种3D欠驱动双足机器人的动力学模型计算方法
技术领域
本发明属于机器人技术领域，具体涉及一种3D欠驱动双足机器人的动力学模型计算方法。
背景技术
双足机器人的动力学建模方法主要有牛顿-欧拉法以及拉格朗日法。当考虑更多自由度机器人的动力学建模问题时，利用牛顿-欧拉法需要关注各个关节细节，计算往往比较复杂，而拉格朗日法更受青睐。《机器人操作的数学导论》一书中基于拉格朗日方法获得了机器人的动力学模型，该模型计算方法为后来的学者所广泛接受。在该书第112页，机器人的动力学模型表示为
在该书中，作者相应的给出了惯性矩阵D以及科氏矩阵C的计算方法：
其中表示第i杆的广义惯性矩，Ji表示第i杆在世界坐标系下的雅可比矩阵。
但是，基于该方法对动力学模型进行编程计算时会导致程序看起来很复杂，不易理解，从而容易出现编程错误。
发明内容
本发明针对3D欠驱动双足机器人，对其在单足支撑相与双足支撑相都进行了动力学建模，并给出了相应的模型计算方法。其中，机器人的双足支撑相由碰撞过程以及坐标切换过程组成。
本发明的技术目的通过以下技术方案实现:
一种3D欠驱动双足机器人的动力学模型计算方法，包括以下步骤：
步骤一，基于DH方法，建立机器人的关节坐标系q＝(q1,q2,q3,q4,q5,q6,q7,q8)，并求出坐标系qk在坐标系qk-1下的齐次转换矩阵其中k＝1,2，..8；
步骤二，假设机器人各杆件的质量集中于质心，基于DH方法，求得各质心在世界坐标系下的位置向量pi以及速度向量vi；进而求得机器人***的总的动能E和势能P：
其中，mi表示第i个杆件的质量，i＝1,2，..5；pi(3)表示向量pi的第三个元素；
步骤三，计算双足机器人在单足支撑相的动力学模型，
其中D为惯性质量矩阵，H为耦合矩阵，B为常数矩阵，u＝[u3,u4,u5,u6,u7,u8]′为主动关节驱动力矩；
步骤四，计算双足机器人与地面碰撞的动力学模型，
其中，De表示增广的惯性质量矩阵，与表示机器人碰撞前后的广义角速度,F2表示地面对摆动腿在接触点的反作用力，表示摆动腿的位置及其方向角对广义坐标系qe的雅可比矩阵；
步骤五，计算机器人的坐标切换模型，其中，主动关节的切换模型为[q3,q4,q5,q6,q7,q8]→[q8,q7,q6,q5,q4,q3]，欠驱动关节的切换模型为[q1,q2]→[q1sw,q2sw]，q1sw表示摆动腿俯仰角，q2sw表示摆动腿滚动角。
进一步的，步骤三中，令则
进一步的，步骤五中，q1sw与q2sw的计算采用几何解析方法，包括以下步骤：
a)在机器人摆动腿末端焊接一根单位长度的虚拟杆一，所述虚拟杆一的方向与坐标系q8的y轴负方向平行，利用所述虚拟杆一在世界坐标系z轴上的投影与虚拟杆一长度的比值来计算摆动腿俯仰角q1sw的大小：
q1sw＝-asin(l1(3)/1)
其中l1表示所述虚拟杆一在世界参考坐标系下的位置向量；
b)在机器人摆动腿末端焊接一根单位长度的虚拟杆二，所述虚拟杆二的方向与坐标系q8的z轴正方向平行，利用所述虚拟杆二在世界坐标系z轴上的投影与虚拟杆二长度的比值来计算摆动腿滚动角q2sw的大小：
q2sw＝asin(l2(3)/1)
其中l2表示所述虚拟杆二在世界参考坐标系下的位置向量。
本发明的有益效果在于：相比于《机器人操作的数学导论》中的动力学模型计算方法，本发明所提出的动力学模型计算方法使得3D欠驱动双足机器人动力学模型各矩阵的编程计算变得简单清晰，便于编程人员的理解和应用，从而提高工作效率；另外，本发明所提出的解析法能够获得3D双足机器人摆动腿滚动角q1sw以及俯仰角q2sw的解析解，使得q1sw以及q2sw的计算结果更加精确，从而可以提高机器人步态的控制精度。
附图说明
图1是本发明中3D欠驱动双足机器人的模型示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步说明。
本发明实施例所涉及的机器人如图1所示，为五杆欠驱动双足机器人，并假设杆件的质量集中于质心。该机器人具有8个独立自由度，q1,q2为机器人支撑腿踝关节角度，q3为机器人支撑腿膝关节角度，q4,q5为支撑腿髋关节角度，q6,q7为摆动腿髋关节角度，q8为摆动腿膝关节角度。其中，自由度q3,q4,q5,q6,q7,q8由力矩直接驱动，为主动关节，而q1,q2为欠驱动关节。
本发明针对上述双足机器人，对其在单足支撑相与双足支撑相都进行了动力学建模，并给出了相应的模型计算方法。其中，机器人的双足支撑相由碰撞过程以及坐标切换过程组成。具体的，计算方法包含以下步骤：
步骤一，基于DH方法，建立机器人的关节坐标系q＝(q1,q2,q3,q4,q5,q6,q7,q8)，并求出坐标系qk在坐标系qk-1下的齐次转换矩阵其中k＝1,2，..8；
步骤二，基于DH方法，求得各质心在世界坐标系下的位置向量pi以及速度向量vi；继而，可求得机器人***的总的动能E和势能P：
其中，mi表示第i个杆件的质量，i＝1,2，..5；pi(3)表示向量pi的第三个元素；
步骤三，计算双足机器人在单足支撑相的动力学模型，令L＝E-P，则动力学模型可表示为
其中惯性质量矩阵耦合矩阵B为常数矩阵，u＝[u3,u4,u5,u6,u7,u8]′为主动关节驱动力矩。
在进行计算编程时，上面所述的偏导数计算可通过matlab提供的jacobian函数来实现。比如计算其matlab程序可为：
D＝jacobian(V,dq)；％dq表示q的导数。
步骤四，计算双足机器人与地面碰撞的动力学模型，
其中，De表示增广的惯性质量矩阵，其计算方法与步骤三类似，与表示机器人碰撞前后的广义角速度,F2表示地面对摆动腿在接触点的反作用力，表示摆动腿的位置及其方向角对广义坐标系qe的雅可比矩阵；
步骤五，计算机器人的坐标切换模型；其中，主动关节的切换模型为[q3,q4,q5,q6,q7,q8]→[q8,q7,q6,q5,q4,q3]，欠驱动关节的切换模型为[q1,q2]→[q1sw,q2sw]。其中，q1sw与q2sw的计算是采用几何解析方法，具体过程为：
a)在机器人摆动腿末端焊接一根单位长度的虚拟杆，该杆的方向与坐标系q8的y轴负方向平行，那么，可以利用这根虚拟杆在世界坐标系z轴上的投影与虚拟杆长度的比值来计算摆动腿俯仰角q1sw的大小：
q1sw＝-asin(l1(3)/1)
其中l1表示虚拟杆在世界参考坐标系下的位置向量；
b)在机器人摆动腿末端焊接一根单位长度的虚拟杆，该杆的方向与q8坐标系的z轴正方向平行，那么，可以利用这根虚拟杆在世界坐标系z轴上的投影与虚拟杆长度的比值来计算摆动腿滚动角q2sw的大小：
q2sw＝asin(l2(3)/1)
其中l2表示虚拟杆在世界参考坐标系下的位置向量。
至此，本实施例完成了3D欠驱动双足机器人的单足支撑相以及双足支撑相的动力学模型计算。
相比于《机器人操作的数学导论》中的动力学模型计算方法，上述方法使得3D欠驱动双足机器人动力学模型各矩阵的编程计算变得简单清晰，便于编程人员的理解和应用，从而提高工作效率；另外，本发明所提出的解析法能够获得3D双足机器人摆动腿滚动角q1sw以及俯仰角q2sw的解析解，使得q1sw以及q2sw的计算结果更加精确，从而可以提高机器人步态的控制精度。
上述实施例仅仅是本发明技术构思实现形式的列举，本发明的保护范围不仅限于上述实施例，本发明的保护范围可延伸至本领域技术人员根据本发明的技术构思所能想到的等同技术手段。

Claims (3)

1.一种3D欠驱动双足机器人的动力学模型计算方法，其特征在于，包括以下步骤：
步骤一，基于DH方法，建立机器人的关节坐标系q＝(q1,q2,q3,q4,q5,q6,q7,q8)，并求出坐标系qk在坐标系qk-1下的齐次转换矩阵其中q1,q2为机器人支撑腿踝关节角度，q3为机器人支撑腿膝关节角度，q4,q5为支撑腿髋关节角度，q6,q7为摆动腿髋关节角度，q8为摆动腿膝关节角度，k＝1,2，..8；
步骤二，假设机器人各杆件的质量集中于质心，基于DH方法，求得各质心在世界坐标系下的位置向量pi以及速度向量vi；进而求得机器人***的总的动能E和势能P：
其中，mi表示第i个杆件的质量，i＝1,2,…5；pi(3)表示向量pi的第三个元素；
步骤三，计算双足机器人在单足支撑相的动力学模型，
其中D为惯性质量矩阵，H为耦合矩阵，B为常数矩阵，u＝[u3,u4,u5,u6,u7,u8]′为主动关节驱动力矩；
步骤四，计算双足机器人与地面碰撞的动力学模型，
其中，De表示增广的惯性质量矩阵，与表示机器人碰撞前后的广义角速度,F2表示地面对摆动腿在接触点的反作用力，表示摆动腿的位置及其方向角对广义坐标系qe的雅可比矩阵；
步骤五，计算机器人的坐标切换模型，其中，主动关节的切换模型为[q3,q4,q5,q6,q7,q8]→[q8,q7,q6,q5,q4,q3]，欠驱动关节的切换模型为[q1,q2]→[q1sw,q2sw]，q1sw表示摆动腿俯仰角，q2sw表示摆动腿滚动角。
2.如权力要求1所述的3D欠驱动双足机器人的动力学模型计算方法，其特征在于，步骤三中，令L＝E-P，则
其中E为机器人***的总动能，P为机器人***的总势能。
3.如权力要求1所述的3D欠驱动双足机器人的动力学模型计算方法，其特征在于，步骤五中，q1sw与q2sw的计算采用几何解析方法，包括以下步骤：
a.在机器人摆动腿末端焊接一根单位长度的虚拟杆一，所述虚拟杆一的方向与坐标系q8的y轴负方向平行，利用所述虚拟杆一在世界坐标系z轴上的投影与虚拟杆一长度的比值来计算摆动腿俯仰角q1sw的大小：
q1sw＝-asin(l1(3)/1)
其中l1表示所述虚拟杆一在世界参考坐标系下的位置向量；
b.在机器人摆动腿末端焊接一根单位长度的虚拟杆二，所述虚拟杆二的方向与坐标系q8的z轴正方向平行，利用所述虚拟杆二在世界坐标系z轴上的投影与虚拟杆二长度的比值来计算摆动腿滚动角q2sw的大小：
q2sw＝asin(l2(3)/1)
其中l2表示所述虚拟杆二在世界参考坐标系下的位置向量。
CN201610028460.4A 2016-01-15 2016-01-15 一种3d欠驱动双足机器人的动力学模型计算方法 Active CN105938364B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610028460.4A CN105938364B (zh) 2016-01-15 2016-01-15 一种3d欠驱动双足机器人的动力学模型计算方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610028460.4A CN105938364B (zh) 2016-01-15 2016-01-15 一种3d欠驱动双足机器人的动力学模型计算方法

Publications (2)

Publication Number Publication Date
CN105938364A CN105938364A (zh) 2016-09-14
CN105938364B true CN105938364B (zh) 2018-09-25

Family

ID=57152913

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610028460.4A Active CN105938364B (zh) 2016-01-15 2016-01-15 一种3d欠驱动双足机器人的动力学模型计算方法

Country Status (1)

Country Link
CN (1) CN105938364B (zh)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109213306B (zh) * 2017-06-30 2022-02-01 沈阳新松机器人自动化股份有限公司 一种机器人远程控制平台及其设计方法
TWI687215B (zh) * 2019-03-05 2020-03-11 國立勤益科技大學 下肢外骨骼機器人及其輔助方法
CN110704984B (zh) * 2019-10-14 2022-06-07 华东交通大学 一种柔性地面上3d欠驱动双足机器人动力学模型计算方法
CN113126638B (zh) * 2019-12-30 2023-07-21 深圳市优必选科技股份有限公司 姿态控制方法、装置、双足机器人及可读存储介质
CN111284584B (zh) * 2020-02-11 2021-01-08 之江实验室 一种双足机器人的单足支撑相步态规划方法
CN111590572B (zh) * 2020-05-15 2021-05-04 深圳国信泰富科技有限公司 一种机器人姿态更新方法及***
CN115981346B (zh) * 2023-03-20 2024-06-07 深圳鹏行智能研究有限公司 机器人控制方法以及机器人

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5355064A (en) * 1992-03-04 1994-10-11 Honda Giken Kogyo Kabushiki Kaisha Control system for legged mobile robot
CN103204193A (zh) * 2013-04-08 2013-07-17 浙江大学 一种欠驱动双足机器人行走控制方法
CN104331081A (zh) * 2014-10-10 2015-02-04 北京理工大学 一种双足机器人斜面行走的步态规划方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004237392A (ja) * 2003-02-05 2004-08-26 Sony Corp ロボット装置、及びロボット装置の表現方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5355064A (en) * 1992-03-04 1994-10-11 Honda Giken Kogyo Kabushiki Kaisha Control system for legged mobile robot
CN103204193A (zh) * 2013-04-08 2013-07-17 浙江大学 一种欠驱动双足机器人行走控制方法
CN104331081A (zh) * 2014-10-10 2015-02-04 北京理工大学 一种双足机器人斜面行走的步态规划方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于熵不确定性概念的机器人位姿精度理论——机器人DH参数误差概率分布数学模型;闫华 等;《华南理工大学学报（自然科学版）》;20000131;第28卷(第1期);第31-37页 *

Also Published As

Publication number Publication date
CN105938364A (zh) 2016-09-14

Similar Documents

Publication Publication Date Title
CN105938364B (zh) 一种3d欠驱动双足机器人的动力学模型计算方法
CN103386683B (zh) 一种基于Kinect的体感控制机械臂方法
CN104331081A (zh) 一种双足机器人斜面行走的步态规划方法
CN102672719B (zh) 一种仿人机器人手臂作业动态稳定控制方法
CN104809276B (zh) 一种多手指机器人动力学解析模型及其建模方法
CN105137969A (zh) 基于支撑线运动分解的四足机器人trot步态本***姿控制方法
CN107671848A (zh) 一种上肢助力外骨骼机构***
CN107953324A (zh) 基于旋量理论和凯恩方法的蛇形机器人动力学分析方法
CN106346480A (zh) 一种基于ug和matlab的多自由度注塑机械臂建模方法
CN110673544A (zh) 基于自适应在线学习的上肢康复机器人控制方法
Shao et al. Dynamic modeling of a two-DoF rotational parallel robot with changeable rotational axes
Zhang et al. Relative dynamic modeling of dual-arm coordination robot
CN106055519B (zh) 一种Stewart并联机构的奇异性分析方法
CN114347017B (zh) 基于平面投影的吸附式移动加工机器人曲面运动控制方法
Chen et al. Optimized 3D stable walking of a bipedal robot with line-shaped massless feet and sagittal underactuation
Luo et al. Planning and control of biped robots with upper body
Fujimoto et al. Control of biped walking robot for human living environment
CN107562968A (zh) 一种足式机器人动力学建模的混合计算方法
Ha et al. Wireless-communicated computed-torque control of a SCARA robot and two-dimensional input shaping for a spherical pendulum
CN103869705A (zh) 一种并联六自由度驱动转台的轨迹规划生成方法
Yuan et al. A study on dynamics of 2-PRR parallel machine tool based on the Lagrange Equation
Liu et al. Stability study of quadruped robot based on foot trajectory improvement
Xia et al. ZMP based motion stability analysis of a wheeled humanoid robot with bending torso
Tu et al. Design and Implementation of Big Humanoid Robot Walking Patterns Based on Inverted Pendulum Approach
Lack Planar multicontact locomotion using hybrid zero dynamics

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant