CN105938364A - 一种3d欠驱动双足机器人的动力学模型计算方法 - Google Patents
一种3d欠驱动双足机器人的动力学模型计算方法 Download PDFInfo
- Publication number
- CN105938364A CN105938364A CN201610028460.4A CN201610028460A CN105938364A CN 105938364 A CN105938364 A CN 105938364A CN 201610028460 A CN201610028460 A CN 201610028460A CN 105938364 A CN105938364 A CN 105938364A
- Authority
- CN
- China
- Prior art keywords
- robot
- represent
- under
- coordinate system
- virtual bar
- 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.)
- Granted
Links
- 238000004364 calculation method Methods 0.000 title abstract description 6
- 238000000034 method Methods 0.000 claims abstract description 26
- 239000011159 matrix material Substances 0.000 claims description 20
- 238000000205 computational method Methods 0.000 claims description 11
- 206010049214 Monopodia Diseases 0.000 claims description 6
- 238000003466 welding Methods 0.000 claims description 6
- 238000004458 analytical method Methods 0.000 claims description 5
- 230000003416 augmentation Effects 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 claims description 3
- 238000005859 coupling reaction Methods 0.000 claims description 3
- 238000005381 potential energy Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 230000008878 coupling Effects 0.000 claims description 2
- 238000012821 model calculation Methods 0.000 abstract 2
- 210000002414 leg Anatomy 0.000 description 18
- 238000005516 engineering process Methods 0.000 description 4
- 230000005021 gait Effects 0.000 description 2
- 210000000629 knee joint Anatomy 0.000 description 2
- 210000000544 articulatio talocruralis Anatomy 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
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欠驱动双足机器人的动力学模型计算方法。
背景技术
双足机器人的动力学建模方法主要有牛顿-欧拉法以及拉格朗日法。当考虑更多自由度机器人的动力学建模问题时,利用牛顿-欧拉法需要关注各个关节细节,计算往往比较复杂,而拉格朗日法更受青睐。《机器人操作的数学导论》一书中基于拉格朗日方法获得了机器人的动力学模型,该模型计算方法为后来的学者所广泛接受。在该书第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下的齐次转换矩阵 其中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,则
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表示所述虚拟杆二在世界参考坐标系下的位置向量。
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 true CN105938364A (zh) | 2016-09-14 |
CN105938364B 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) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109213306A (zh) * | 2017-06-30 | 2019-01-15 | 沈阳新松机器人自动化股份有限公司 | 一种机器人远程控制平台及其设计方法 |
CN110704984A (zh) * | 2019-10-14 | 2020-01-17 | 华东交通大学 | 一种柔性地面上3d欠驱动双足机器人动力学模型计算方法 |
TWI687215B (zh) * | 2019-03-05 | 2020-03-11 | 國立勤益科技大學 | 下肢外骨骼機器人及其輔助方法 |
CN111284584A (zh) * | 2020-02-11 | 2020-06-16 | 之江实验室 | 一种双足机器人的单足支撑相步态规划方法 |
CN111590572A (zh) * | 2020-05-15 | 2020-08-28 | 深圳国信泰富科技有限公司 | 一种机器人姿态更新方法及*** |
CN113126638A (zh) * | 2019-12-30 | 2021-07-16 | 深圳市优必选科技股份有限公司 | 姿态控制方法、装置、双足机器人及可读存储介质 |
CN115981346A (zh) * | 2023-03-20 | 2023-04-18 | 深圳鹏行智能研究有限公司 | 机器人控制方法以及机器人 |
Citations (4)
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 |
US20040210345A1 (en) * | 2003-02-05 | 2004-10-21 | Kuniaki Noda | Buffer mechanism and recording and/or reproducing apparatus |
CN103204193A (zh) * | 2013-04-08 | 2013-07-17 | 浙江大学 | 一种欠驱动双足机器人行走控制方法 |
CN104331081A (zh) * | 2014-10-10 | 2015-02-04 | 北京理工大学 | 一种双足机器人斜面行走的步态规划方法 |
-
2016
- 2016-01-15 CN CN201610028460.4A patent/CN105938364B/zh active Active
Patent Citations (4)
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 |
US20040210345A1 (en) * | 2003-02-05 | 2004-10-21 | Kuniaki Noda | Buffer mechanism and recording and/or reproducing apparatus |
CN103204193A (zh) * | 2013-04-08 | 2013-07-17 | 浙江大学 | 一种欠驱动双足机器人行走控制方法 |
CN104331081A (zh) * | 2014-10-10 | 2015-02-04 | 北京理工大学 | 一种双足机器人斜面行走的步态规划方法 |
Non-Patent Citations (1)
Title |
---|
闫华 等: "基于熵不确定性概念的机器人位姿精度理论——机器人DH参数误差概率分布数学模型", 《华南理工大学学报(自然科学版)》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109213306A (zh) * | 2017-06-30 | 2019-01-15 | 沈阳新松机器人自动化股份有限公司 | 一种机器人远程控制平台及其设计方法 |
TWI687215B (zh) * | 2019-03-05 | 2020-03-11 | 國立勤益科技大學 | 下肢外骨骼機器人及其輔助方法 |
CN110704984A (zh) * | 2019-10-14 | 2020-01-17 | 华东交通大学 | 一种柔性地面上3d欠驱动双足机器人动力学模型计算方法 |
CN110704984B (zh) * | 2019-10-14 | 2022-06-07 | 华东交通大学 | 一种柔性地面上3d欠驱动双足机器人动力学模型计算方法 |
CN113126638A (zh) * | 2019-12-30 | 2021-07-16 | 深圳市优必选科技股份有限公司 | 姿态控制方法、装置、双足机器人及可读存储介质 |
CN113126638B (zh) * | 2019-12-30 | 2023-07-21 | 深圳市优必选科技股份有限公司 | 姿态控制方法、装置、双足机器人及可读存储介质 |
CN111284584A (zh) * | 2020-02-11 | 2020-06-16 | 之江实验室 | 一种双足机器人的单足支撑相步态规划方法 |
CN111590572A (zh) * | 2020-05-15 | 2020-08-28 | 深圳国信泰富科技有限公司 | 一种机器人姿态更新方法及*** |
CN111590572B (zh) * | 2020-05-15 | 2021-05-04 | 深圳国信泰富科技有限公司 | 一种机器人姿态更新方法及*** |
CN115981346A (zh) * | 2023-03-20 | 2023-04-18 | 深圳鹏行智能研究有限公司 | 机器人控制方法以及机器人 |
CN115981346B (zh) * | 2023-03-20 | 2024-06-07 | 深圳鹏行智能研究有限公司 | 机器人控制方法以及机器人 |
Also Published As
Publication number | Publication date |
---|---|
CN105938364B (zh) | 2018-09-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105938364A (zh) | 一种3d欠驱动双足机器人的动力学模型计算方法 | |
US11883959B2 (en) | Articulated, closed kinematic chain planar monopod | |
Kajita et al. | The 3D linear inverted pendulum mode: A simple modeling for a biped walking pattern generation | |
CN105599816B (zh) | 一种3d欠驱动双足机器人跳跃运动的步态规划方法 | |
CN104331081A (zh) | 一种双足机器人斜面行走的步态规划方法 | |
CN105137969A (zh) | 基于支撑线运动分解的四足机器人trot步态本***姿控制方法 | |
CN112859856B (zh) | 一种基于质心高度补偿的仿人机器人步态生成方法 | |
CN110371213A (zh) | 一种双足机器人步行规划和控制方法 | |
CN112847371B (zh) | 一种仿人机器人动态跨越连续障碍物的运动规划方法 | |
Harata et al. | Biped gait generation based on parametric excitation by knee-joint actuation | |
Luo et al. | Principle and method of speed control for dynamic walking biped robots | |
CN110909438B (zh) | 一种基于动力学模型的轻载关节型并联机器人控制方法 | |
Park et al. | Fourier series-based walking pattern generation for a biped humanoid robot | |
CN103217924A (zh) | 面向实时控制应用的过约束重型并联机床动力学建模方法 | |
CN105938499A (zh) | 一种3d双足机器人的坐标系建立方法 | |
Chen et al. | Optimized 3D stable walking of a bipedal robot with line-shaped massless feet and sagittal underactuation | |
CN103869705A (zh) | 一种并联六自由度驱动转台的轨迹规划生成方法 | |
Hou et al. | Follow my step: A framework for biped robots to imitate human walking | |
Yilmaz et al. | Circular arc-shaped walking trajectory generation for bipedal humanoid robots | |
Zhang et al. | Research on gait planning and inverse kinematics solving of biped walking robots | |
Wang et al. | Design and analysis of a line-walking robot for power transmission line inspection | |
Xia et al. | ZMP based motion stability analysis of a wheeled humanoid robot with bending torso | |
Harata et al. | Parametric excitation-based inverse bending gait generation | |
Zang et al. | Control strategy research for a biped walking robot with flexible ankle joints | |
Gao et al. | Kinematics simulation of a hybrid leg structure of a novel quadruped robot |
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 |