CN112882467B - 一种双足仿人机器人在斜坡上行走的步态规划方法 - Google Patents
一种双足仿人机器人在斜坡上行走的步态规划方法 Download PDFInfo
- Publication number
- CN112882467B CN112882467B CN202110036275.0A CN202110036275A CN112882467B CN 112882467 B CN112882467 B CN 112882467B CN 202110036275 A CN202110036275 A CN 202110036275A CN 112882467 B CN112882467 B CN 112882467B
- Authority
- CN
- China
- Prior art keywords
- slope
- humanoid robot
- inverted pendulum
- biped humanoid
- pendulum 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 65
- 230000005021 gait Effects 0.000 title claims abstract description 25
- 230000033001 locomotion Effects 0.000 claims abstract description 35
- 230000008569 process Effects 0.000 claims abstract description 9
- 230000008859 change Effects 0.000 claims description 10
- 239000004973 liquid crystal related substance Substances 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000009194 climbing Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000004088 simulation Methods 0.000 description 9
- 241000282414 Homo sapiens Species 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
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/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种双足仿人机器人在斜坡上行走的步态规划方法。包括如下步骤:步骤1,基于虚拟地面法的双足仿人机器人在斜坡上的动力学模型,具体过程包括:斜坡上的传统二维直线倒立摆模型、斜坡上基于虚拟地面法的二维直线倒立摆模型、斜坡上基于虚拟地面法的三维直线倒立摆模型和斜坡上基于虚拟地面法的直线倒立摆模型的仿人机器人的质心运动;步骤2,在所述步骤1的基础之上,通过不对称直线倒立摆方法实现双足仿人机器人在斜坡上任意方向的稳定且动态行走。本发明通过虚拟地面法和不对称直线倒立摆方法,使得双足仿人机器人在斜坡上的任意方向以更小的着陆冲击稳定且动态的行走,并获得在斜坡上稳定实用的行走步态。
Description
技术领域
本发明涉及机器人运动学建模领域,特别是一种双足仿人机器人在斜坡上行走的步态规划方法。
背景技术
全尺寸双足仿人机器人在各种环境中具有良好的适应性,有望为人类的日常生活和工作提供帮助。仿人机器人的腿部设计更适合在有障碍物或不连续高度变化的地形上移动。然而,这也是对仿人机器人动态平衡的挑战。如何使双足仿人机器人在地面上更快、更稳定地行走,是近几十年来长期研究的热点。然而,为了使双足仿人机器人具有较强的适应人类生活环境的能力,许多研究都集中在双足机器人在斜坡、楼梯甚至未知的崎岖地形上行走。此外,许多研究学者对斜坡上行走的仿人机器人步态生成优化和智能稳定控制算法进行了研究。以往关于仿人机器人在斜坡上行走的研究,包括使用3D线性倒立摆模型,并没有给出仿人机器人的零力矩点和转弯行走步态模式的明确表达式。此外,在大多数研究中,只考虑了仿人机器人沿俯仰方向的倾斜,而对于在斜坡上转弯的仿人机器人,其着陆冲击的降低还没有得到很好的研究。在真实的环境中,斜坡可能不是平坦的,因此机器人需要具有不同方向行走的能力,以避开障碍物或地形。
发明内容
针对现有技术中存在的问题,本发明提供了一种通过虚拟地面法和不对称直线倒立摆方法,使得双足仿人机器人在斜坡上的任意方向以更小的着陆冲击稳定且动态的行走,并获得在斜坡上稳定实用的行走步态的双足仿人机器人在斜坡上行走的步态规划方法。
本发明的目的通过以下技术方案实现。
一种双足仿人机器人在斜坡上行走的步态规划方法,包括如下步骤:
步骤1):基于虚拟地面法的双足仿人机器人在斜坡上的动力学模型,具体过程包括:斜坡上的传统二维直线倒立摆模型、斜坡上基于虚拟地面法的二维直线倒立摆模型、斜坡上基于虚拟地面法的三维直线倒立摆模型和斜坡上基于虚拟地面法的直线倒立摆模型的仿人机器人的质心运动;所述步骤2):通过不对称直线倒立摆方法实现双足仿人机器人在斜坡上任意方向的稳定且动态行走。
进一步的,所述步骤1)具体包括如下:
所述斜坡上的传统二维直线倒立摆模型的爬坡双足仿人机器人,力F限制双足仿人机器人的质心沿约束线移动;
所述斜坡上基于虚拟地面法的二维直线倒立摆模型:传统二维直线倒立摆模型中的x-y平面与地面坐标不平行,需要进行坐标旋转变换才能得到零力矩点,使用虚拟地面法,就像机器人在水平的平地上行走一样,但是重力方向会随着坡度的变化而变化;
倒立摆锤的输入包括支点处的扭矩τ和沿支腿的拉伸力F,使用拉格朗日方法,动力学运动方程可以写成:
这里,τ=0,F=Mgcosα/cosθ,质心以恒定的高度z=zc进行移动,运动方程可以写成如下:
得到微分方程:
所述斜坡上基于虚拟地面法的三维直线倒立摆模型,拉伸力F可以分解为x、y和z方向的分量,即:
零力矩点方程得到如下:
斜坡上一个步长内基于虚拟地面法的直线倒立摆模型的质心运动,斜坡三维直线倒立摆模型下质心运动表示为:
在双腿支撑时间间隔[0,T]内,质心在矢向面和横向面的最终状态为:
矢向运动:
横向运动:
为了改变双足仿人机器人在斜坡上行走时的方向,其它步态信息需要如下:
进一步的,所述步骤2)具体包括如下:
在传统的基于直线倒立摆模型中,引入不对称直线倒立摆模型具体步骤包括如下:
将双足仿人机器人的质心高度限制在不对称直线倒立摆模型的一个平面,如下式所示:
z=kxx+kyy+zc
将双足仿人机器人的质心在限定的平面内运动,约束平面的法向量应垂直于双足仿人机器人的加速度,如下式所示:
z=kxx+zc
不对称直线倒立摆模型下的双足仿人机器人的质心运动轨迹,如下式所示:
在双腿支撑时间间隔[0,T],质心在矢向面和横向面的最终状态为:
矢向运动:
横向运动:
为了改变双足仿人机器人在斜坡上行走方向,步态生成器可以表达如下:
相比于现有技术,本发明的优点在于:
1、本发明通过虚拟地面法和不对称直线倒立摆方法,实现了双足仿人机器人在斜坡上的任意方向以更小的着陆冲击稳定且动态的行走。
2、本发明可有效提升双足仿人机器人的应用范围,在机器人的工程实践应用中具有重要的意义。
附图说明
图1为本发明的一种双足仿人机器人在斜坡上行走的步态规划方法的步骤流程图;
图2为DRC-XT机器人本体图;
图3为DRC-XT机器人在OpenHRP仿真引擎中在斜坡上行走时的横向面的完整步态;
图4为DRC-XT机器人在OpenHRP仿真引擎中在斜坡上行走时的矢向面的完整步态;
图5为DRC-XT机器人实测时的斜坡环境;
图6为DRC-XT机器人在斜坡环境上的实测行走步态;
图7为斜坡上的传统二维直线倒立摆模型受力分解图;
图8为斜坡上基于虚拟地面法的二维直线倒立摆模型受力分解图;
图9为斜坡上基于虚拟地面法的三维直线倒立摆模型受力飞分解图。
具体实施方式
下面结合说明书附图和具体的实施例,对本发明作详细描述。
如图1所示,一种双足仿人机器人在斜坡上行走的步态规划方法,包括如下步骤:步骤 1,基于虚拟地面法的双足仿人机器人在斜坡上的动力学模型,具体过程包括:斜坡上的传统二维直线倒立摆模型、斜坡上基于虚拟地面法的二维直线倒立摆模型、斜坡上基于虚拟地面法的三维直线倒立摆模型和斜坡上基于虚拟地面法的直线倒立摆模型的仿人机器人的质心运动;步骤2,在所述步骤1的基础之上,通过不对称直线倒立摆方法实现双足仿人机器人在斜坡上任意方向的稳定且动态行走。
所述步骤1包括如下:
SS00斜坡上的传统二维直线倒立摆模型,如图7所示,传统二维直线倒立摆模型的爬坡双足仿人机器人,力F限制双足仿人机器人的质心沿约束线移动;
SS01斜坡上基于虚拟地面法的二维直线倒立摆模型,传统二维直线倒立摆模型中的x-y 平面与地面坐标不平行,需要进行坐标旋转变换才能得到零力矩点。使用虚拟地面法,就像机器人在水平的平地上行走一样,但是重力方向会随着坡度的变化而变化,如图8所示;
图中倒立摆锤的输入包括支点处的扭矩τ和沿支腿的拉伸力F,使用拉格朗日方法,动力学运动方程可以写成:
这里,τ=0,F=Mgcosα/cosθ,质心以恒定的高度z=zc进行移动,运动方程可以写成如下:
得到微分方程:
SS02斜坡上基于虚拟地面法的三维直线倒立摆模型,拉伸力F可以分解为x、y和z方向的分量,如图9所示:
即:
零力矩点方程得到如下:
SS03斜坡上一个步长内基于虚拟地面法的直线倒立摆模型的质心运动,斜坡三维直线倒立摆模型下质心运动表示为:
在双腿支撑时间间隔[0,T]内,质心在矢向面和横向面的最终状态为:
矢向运动:
横向运动:
为了改变双足仿人机器人在斜坡上行走时的方向,其它步态信息需要如下:
所述步骤2包括如下:
在所述步骤1的基础之上,在传统的基于直线倒立摆模型中,双足仿人机器人的质心高度是恒定的。但是考虑到实际的机器人,两条腿的长度并不完全一样。对于不对称直线倒立摆模型,双足仿人机器人的质心高度不是恒定的,机器人的两条腿的运动也是不对称的。考虑到单质量模型的不精确性造成的双足仿人机器人着陆反作用力较大的问题,引入不对称直线倒立摆模型来解决这一问题,具体步骤包括如下:
SS00将双足仿人机器人的质心高度限制在不对称直线倒立摆模型的一个平面,如下式所示:
z=kxx+kyy+zc
SS01将双足仿人机器人的质心在限定的平面内运动,约束平面的法向量应垂直于双足仿人机器人的加速度,如下式所示:
z=kxx+zc
SS02不对称直线倒立摆模型下的双足仿人机器人的质心运动轨迹,如下式所示:
在双腿支撑时间间隔[0,T],质心在矢向面和横向面的最终状态为:
矢向运动:
横向运动:
为了改变双足仿人机器人在斜坡上行走方向,步态生成器可以表达如下:
实施例一
一种双足仿人机器人在斜坡上行走的步态规划方法应用于DRC-XT机器人,在OpenHRP仿真平台中的仿真过程如下:
请参阅图2、图3和图4所示,DRC-XT是一款智能的灾难救援机器人,具有一个成人大小的双足仿人机器人,且有足够的自由度来进行复杂的运动。在OpenHRP仿真平台中使用DRC-XT机器人真实的参数,构建虚拟双足仿人机器人。在仿真引擎中进行DRC-XT机器人在斜坡上行走仿真实验,如图3和图4所示。在仿真中,设置倾角为α=12,转弯角度为θ=-π/2,且斜坡平坦,静摩擦系数和滑动摩擦系数保证了机器人的正常运动。图3和图4分别显示了DRC-XT机器人在OpenHRP仿真引擎中在斜坡上行走时的横向面和矢向面的完整步态循环,其具体行走过程如下:
首先,机器人慢慢下蹲以降低质心的高度,这需要3秒。然后,机器人以0.3s的速度迈出第一步,第一步的整个时间间隔为1.2s。之后,紧接的两步都需要1秒。最后,摆动腿最后一步在7.1s时落在斜坡上,7.4s后机器人再次静止。
实施例二
一种双足仿人机器人在斜坡上行走的步态规划方法在DRC-XT机器人的实测过程如下:
请参阅图2、图5和图6所示,DRC-XT是一款智能的灾难救援机器人,具有一个成人大小的双足仿人机器人,且有足够的自由度来进行复杂的运动。图5显示了DRC-XT机器人在斜坡上行走的斜坡环境,倾角也是α=12。图6显示了DRC-XT机器人在斜坡上行走的整个过程,转弯角度θ=-π/2,DRC-XT机器人在斜坡上的整个行走过程与实施例一的结果几乎一致。
Claims (1)
1.一种双足仿人机器人在斜坡上行走的步态规划方法,其特征在于,包括如下步骤:
步骤1):基于虚拟地面法的双足仿人机器人在斜坡上的动力学模型,具体过程包括:斜坡上的传统二维直线倒立摆模型、斜坡上基于虚拟地面法的二维直线倒立摆模型、斜坡上基于虚拟地面法的三维直线倒立摆模型和斜坡上基于虚拟地面法的直线倒立摆模型的仿人机器人的质心运动;步骤2):通过不对称直线倒立摆方法实现双足仿人机器人在斜坡上任意方向的稳定且动态行走;
所述步骤1)具体包括如下:
所述斜坡上的传统二维直线倒立摆模型的爬坡双足仿人机器人,力F限制双足仿人机器人的质心沿约束线移动;
所述斜坡上基于虚拟地面法的二维直线倒立摆模型:传统二维直线倒立摆模型中的x-y平面与地面坐标不平行,需要进行坐标旋转变换才能得到零力矩点,使用虚拟地面法,就像机器人在水平的平地上行走一样,但是重力方向会随着坡度的变化而变化;
倒立摆锤的输入包括支点处的扭矩τ和沿支腿的拉伸力F,α为斜坡的倾角,θ为双足仿人机器人在斜坡上的转弯角度,M为双足仿人机器人质心的质量,r为伸缩腿长,使用拉格朗日方法,动力学运动方程可以写成:
这里,τ=0,F=Mg cosα/cosθ,质心以恒定的高度z=zc进行移动,运动方程可以写成如下:
得到微分方程:
所述斜坡上基于虚拟地面法的三维直线倒立摆模型,拉伸力F可以分解为x、y和z方向的分量,即:
零力矩点方程得到如下:
斜坡上一个步长内基于虚拟地面法的直线倒立摆模型的质心运动,斜坡三维直线倒立摆模型下质心运动表示为:
在双腿支撑时间间隔[0,T]内,质心在矢向面和横向面的最终状态为:
矢向运动:
横向运动:
为了改变双足仿人机器人在斜坡上行走时的方向,其它步态信息需要如下:
所述步骤2)具体包括如下:
在传统的基于直线倒立摆模型中,引入不对称直线倒立摆模型具体步骤包括如下:
将双足仿人机器人的质心高度限制在不对称直线倒立摆模型的一个平面,如下式所示:
z=kxx+kyy+zc
将双足仿人机器人的质心在限定的平面内运动,约束平面的法向量应垂直于双足仿人机器人的加速度,如下式所示:
z=kxx+zc
不对称直线倒立摆模型下的双足仿人机器人的质心运动轨迹,如下式所示:
在双腿支撑时间间隔[0,T],质心在矢向面和横向面的最终状态为:
矢向运动:
横向运动:
为了改变双足仿人机器人在斜坡上行走方向,步态生成器可以表达如下:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110036275.0A CN112882467B (zh) | 2021-01-12 | 2021-01-12 | 一种双足仿人机器人在斜坡上行走的步态规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110036275.0A CN112882467B (zh) | 2021-01-12 | 2021-01-12 | 一种双足仿人机器人在斜坡上行走的步态规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112882467A CN112882467A (zh) | 2021-06-01 |
CN112882467B true CN112882467B (zh) | 2022-11-18 |
Family
ID=76044273
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110036275.0A Active CN112882467B (zh) | 2021-01-12 | 2021-01-12 | 一种双足仿人机器人在斜坡上行走的步态规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112882467B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114248855B (zh) * | 2021-12-20 | 2022-10-21 | 北京理工大学 | 双足机器人空间域步态规划与控制的方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104331081A (zh) * | 2014-10-10 | 2015-02-04 | 北京理工大学 | 一种双足机器人斜面行走的步态规划方法 |
CN104443114A (zh) * | 2014-11-05 | 2015-03-25 | 上海大学 | 一种基于倒立摆调整重心的龙行车式滑行机器人 |
CN108089578A (zh) * | 2017-12-07 | 2018-05-29 | 东莞深圳清华大学研究院创新中心 | 一种用于双足步行机器人的步行运动规划方法 |
KR20180057173A (ko) * | 2016-11-22 | 2018-05-30 | 한국과학기술연구원 | 이족 보행 로봇의 안정된 보행 제어를 위해 단순화된 로봇의 모델링 방법 |
CN110286679A (zh) * | 2019-06-24 | 2019-09-27 | 南京理工大学 | 基于线性倒立摆模型的机器人步态规划方法 |
-
2021
- 2021-01-12 CN CN202110036275.0A patent/CN112882467B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104331081A (zh) * | 2014-10-10 | 2015-02-04 | 北京理工大学 | 一种双足机器人斜面行走的步态规划方法 |
CN104443114A (zh) * | 2014-11-05 | 2015-03-25 | 上海大学 | 一种基于倒立摆调整重心的龙行车式滑行机器人 |
KR20180057173A (ko) * | 2016-11-22 | 2018-05-30 | 한국과학기술연구원 | 이족 보행 로봇의 안정된 보행 제어를 위해 단순화된 로봇의 모델링 방법 |
CN108089578A (zh) * | 2017-12-07 | 2018-05-29 | 东莞深圳清华大学研究院创新中心 | 一种用于双足步行机器人的步行运动规划方法 |
CN110286679A (zh) * | 2019-06-24 | 2019-09-27 | 南京理工大学 | 基于线性倒立摆模型的机器人步态规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112882467A (zh) | 2021-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Tonneau et al. | An efficient acyclic contact planner for multiped robots | |
Schwab et al. | Basin of attraction of the simplest walking model | |
Transeth et al. | 3-D snake robot motion: nonsmooth modeling, simulations, and experiments | |
US9120227B2 (en) | Human motion tracking control with strict contact force constraints for floating-base humanoid robots | |
Stoeter et al. | Kinematic motion model for jumping scout robots | |
CN112859856B (zh) | 一种基于质心高度补偿的仿人机器人步态生成方法 | |
Pa et al. | Design of a hexapod robot with a servo control and a man-machine interface | |
CN112847371B (zh) | 一种仿人机器人动态跨越连续障碍物的运动规划方法 | |
CN112882467B (zh) | 一种双足仿人机器人在斜坡上行走的步态规划方法 | |
Wang et al. | Trajectory planning of a rolling robot of closed five-bow-shaped-bar linkage | |
Eldirdiry et al. | Modeling biomechanical legs with toe-joint using simscape | |
Saltaren et al. | Climbing parallel robot: A computational and experimental study of its performance around structural nodes | |
Chang et al. | Inverted pendulum model for turn-planning for biped robot | |
Mahboubi et al. | Design and implementation of a novel hybrid quadruped spherical mobile robot | |
Ponce et al. | Modeling and simulation for designing a line walking chameleon-like legged robot | |
Robson et al. | Robust multilegged walking robots for interactions with different terrains | |
Fang et al. | Theoretical and experimental study on a compliant flipper-leg during terrestrial locomotion | |
Kim et al. | Solving an inverse kinematics problem for a humanoid robots imitation of human motions using optimization | |
Bi et al. | Kinematic analysis on land of an amphibious spherical robot system | |
Kajita et al. | Limbed systems | |
Lathan et al. | Analytical approach for generating dynamically balanced gaits for obstacle crossing biped robot | |
Zhang et al. | Obstacle Capability of an Air‐Ground Amphibious Reconnaissance Robot with a Planetary Wheel‐Leg Type Structure | |
Damghani et al. | Brachiation Robot Dynamics Modelling | |
Jia et al. | Kinematics analysis of walking robot based on double stewart parallel mechanism | |
Alyushin et al. | Mathematical model of Stewart platform motion |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |