CN113830197B - 一种应用于双足机器人动态行走的平衡控制方法 - Google Patents
一种应用于双足机器人动态行走的平衡控制方法 Download PDFInfo
- Publication number
- CN113830197B CN113830197B CN202111390083.6A CN202111390083A CN113830197B CN 113830197 B CN113830197 B CN 113830197B CN 202111390083 A CN202111390083 A CN 202111390083A CN 113830197 B CN113830197 B CN 113830197B
- Authority
- CN
- China
- Prior art keywords
- robot
- plane
- walking
- foot
- biped
- 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 45
- 230000005021 gait Effects 0.000 claims abstract description 12
- 238000004364 calculation method Methods 0.000 claims description 8
- 241000282414 Homo sapiens Species 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000011217 control strategy Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 239000002360 explosive Substances 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 210000001364 upper extremity Anatomy 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种双足机器人动态行走的平衡控制方法,该方法首先规划理想步态,进一步根据机器人当前状态计算落脚时间并确定优先平面,基于优先平面计算落脚点位置实现在存在外部扰动的情况下对落脚点的规划控制。本发明无需对扰动的大小和方向进行测量,仅通过观测扰动施加后机器人的状态变化,实现机器人的平衡控制,可用于双足机器人全向行走过程中受到各个方向扰动的情形。
Description
技术领域
本发明涉及机器人领域,具体涉及一种应用于双足机器人动态行走的平衡控制方法。
背景技术
双足机器人具有仿人的形态和类似人类行走的位移方式,相比于传统的轮式移动机器人,更能适应人类的工作和生活环境,是未来配合或者代替人类工作的终极机器人形态。双足机器人走向实际应用需要在行走稳定性、步态多样性、行走速度和能耗等方面均达到较高水平。尽管近年来世界范围内多款双足机器人样机展示了一些性能上的提升,但距离人类的行走性能仍有较大的差距。在上述四个主要行走性能中,行走稳定性是最重要的性能,也是其他性能进一步体现的前提条件,没有强稳定性的保障,双足行走的其他性能都无从谈起。
行走稳定性的主要体现形式是在机器人行走过程中受到外力扰动时,能否保持平衡而不摔倒,并逐渐恢复到原有的行走姿态中。由于双足行走是两只脚交替与地面接触并带动上肢进行位移的混杂过程,机器人的双足行走过程本身具有较高的不稳定性,行走平衡控制的复杂度和难度较高。目前已有一些平衡控制算法被提出并应用在双足机器人样机上,基于混杂零动态(HZD)的极限环控制方法被应用到双足机器人的平衡控制中,但受限于该方法的收敛域极小,只能抵抗较小的扰动;本田公司的仿人机器人ASIMO和韩国的仿人机器人HUBO均采用零力矩点(ZMP)的规划和平衡控制方式,机器人的零力矩点不能超出脚板构成的支撑多边形,步态的动态性能差,行走能效低且行走稳定性差;波士顿动力的Atlas机器人基于捕获点的方法实现平衡控制,展示了较高的动态性能和爆发力,但在抗外部扰动时的平衡性能展示较少。总之,现有应用于双足机器人的平衡控制方案有的为了追求稳定性放弃了行走的动态性能,有的追求动态性能而降低了行走稳定性,如何实现兼具动态性能和平衡能力的行走是运动控制领域的核心问题。
发明内容
本发明的目的是为了解决上述问题,提出一种应用于双足机器人动态行走的平衡控制方法。
本发明的目的通过以下技术方案实现:
一种双足机器人动态行走的平衡控制方法,包括以下步骤:
步骤一,获取双足机器人行走速度指令,并统一为二维的行走速度向量形式;
步骤二,对双足机器人规划理想步态,并根据步骤一获得的行走速度向量及机器
人相关信息计算获得双足机器人在完成当前步,并向下一步切换时的理想质心状态,分别表示机器人在完成当前步,并向下一步切换时质心在x方向和y方向
的理想位置,分别表示机器人在完成当前步,并向下一步切换时质心在x方向和y方向的
理想速度;
步骤三,实时获取双足机器人的当前质心状态,其中, 分别表示
当前时刻机器人质心在x方向和y方向的位置, 分别表示当前时刻机器人质心在x方向
和y方向的速度;结合步骤二获取的双足机器人在完成当前步,并向下一步切换时的理想质
心状态依次计算前向平面内机器人的落脚时间和侧向平面内机器人的落脚时间并确定优
先平面;
步骤四,以优先平面的落脚时间作为本次落脚控制的剩余摆动时间,计算优先平面的ZMP点和落脚点、非优先平面的ZMP点和落脚点,从而实现存在外部扰动的情况下对落脚点的规划和平衡控制。
进一步地,所述步骤二中,利用简化的三维倒立摆模型作为对象对双足机器人规
划理想步态,根据步骤一获得的行走速度向量及机器人相关信息计算获得双足机器人在完
成当前步,并向下一步切换时的理想质心状态具体如下:
其中,V x 为机器人向正前方的行走速度,V y 为向正左方的行走速度;V x max为机器人
前向行走速度最大值;为在侧向速度指令为V y 时,双足切换状态下的质心侧
向位置;为机器人质心在行走过程中距离支撑脚中心点最近点至双足切换
状态的时间;α为机器人质心在行走过程中距离支撑脚中心点最近时沿y轴方向的距离;δ为
机器人质心在双足切换状态时距离支撑脚中心点沿y轴方向的距离;σ为机器人质心距离支
撑脚中心点距离最近时沿x方向的行走速度;ω为机器人侧向行走速度为最大值V y max时,质
心在双足切换状态时距离支撑脚中心点沿y方向的距离;λϵ{-1,1}用于说明当前的双足支
撑状态;C为双足机器人的行走高度参数。
进一步地,所述步骤三中,实时获取双足机器人的当前质心状态,结合
步骤二获取的双足机器人在完成当前步,并向下一步切换时的理想质心状态依次计算前向
平面内机器人的落脚时间和侧向平面内机器人的落脚时间,具体为:
规划ZMP偏移量:其中,侧向平面内对应的ZMP偏移量计算如下,
前向平面内对应的ZMP偏移量如下,
式中,C为双足机器人的行走高度参数;
根据ZMP偏移量计算落脚时间如下:
进一步地,所述步骤三中,确定优先平面具体为:选择落脚时间小对应的平面为优先平面。
进一步地,所述步骤四具体为:
以优先平面的落脚时间作为本次落脚控制的剩余摆动时间t t0,同时结合平面的ZMP偏移量,分别计算前向平面和侧向平面的落脚位置,结合机器人本体的结构布局,选取通用的逆运动学解算方法,完成对机器人各个关节角度的实时规划计算;其中,侧向平面的落脚位置计算方法如下:
C为双足机器人的行走高度参数;
进一步计算落脚点优先平面对应的坐标如下:
α为机器人质心在行走过程中距离支撑脚中心点最近时的沿y轴方向的距离;λϵ{-1,1}用于说明当前的双足支撑状态;
进一步计算双足机器人到达双足切换位置时的前向速度如下,
最后计算落脚点非优先平面对应的坐标如下:
本发明的有益效果是:
本发明方法根据机器人当前状态计算落脚时间并确定优先平面,基于优先平面落脚点时间作为本次落脚控制的剩余摆动时间计算落脚点位置,实现在存在外部扰动的情况下对落脚点的规划控制。本发明方法无需对扰动的大小和方向进行测量,仅通过观测扰动施加后机器人的状态变化,实现机器人的平衡控制,可用于双足机器人全向行走过程中受到各个方向扰动的情形。
附图说明
图1为三维倒立摆模型及其坐标系定义说明示意图;
图2为一步行走过程中质心投影轨迹与支撑脚相对位置关系参数的说明示意图;
图3为一步行走过程中质心投影轨迹与支撑脚、落脚点之间的位置关系说明示意图。
具体实施方式
以下结合附图和实施例对本发明作进一步说明。
本发明的一种双足机器人动态行走的平衡控制方法,包含以下步骤:
步骤一:处理输入的双足机器人行走速度指令信息
如图1所示,为处在三维空间的机器人定义坐标系,以支撑脚中心点1-1作为坐标原点,以机器人前向行走方向为x轴正方向,以机器人左侧方向为y轴正方向,以竖直向上方向为z轴正方向。本发明的运动控制方法输入形式为二维的行走速度向量(V x , V y ),其中V x 为机器人向正前方的行走速度,V y 为向正左方的行走速度。当输入为其他形式时,可通过步幅(步长)和行走频率等步态信息进行转换,统一为上述行走速度向量形式。
步骤二:规划理想步态
为保证系统的动态性能,步态规划算法需要具备高实时性,为了简化运算复杂度,
在综合分析算法有效性的前提下,本发明选用简化的三维倒立摆模型作为对象实现步态规
划,三维倒立摆模型质心1-2如图所示,规划机器人行走过程中的质心高度为h CoM ,定义机器
人行走高度参数为,其中g为重力加速度常量,则三维倒立摆在前向和侧向的运动
可以进行解耦,以机器人质心在水平面上的投影坐标(x, y)作为状态变量,则系统的动态
方程如下,
如图2所示,α为机器人质心在行走过程中距离支撑脚中心点最近时沿y轴方向的距离;δ为机器人质心在双足切换状态时距离支撑脚中心点沿y轴方向的距离;σ为机器人质心距离支撑脚中心点最近时沿x方向的行走速度(图中未示出);ω为机器人侧向行走速度为最大值V y max时,质心在双足切换状态时距离支撑脚中心点沿y方向的距离。
进一步计算由质心距离支撑脚最近点至双足切换状态的时间τ如下,
其中分别表示机器人在完成当前步,并向下一步切换时质心在x方向和y方向
的理想位置,分别表示机器人在完成当前步,并向下一步切换时质心在x方向和y方向的
理想速度,V x max为机器人前向行走速度最大值;λϵ{-1,1}用来说明当前的双足支撑状态,当
右脚为支撑脚时λ=1,当左脚为支撑脚时,λ=-1。
步骤三:计算落脚时间并确定优先平面
机器人行走的动态平衡需要同时考虑来自机器人各个方向的扰动,本发明无需对扰动的大小和方向进行测量,仅通过观测扰动施加后机器人的状态变化,并基于机器人的实时状态即可实现平衡控制。
如图3中3-4所示,机器人当前时刻的质心状态为,分别表示当前
时刻机器人质心在x方向和y方向的位置,分别表示当前时刻机器人质心在x方向和y方
向的速度。采用前向平面与侧向平面解耦的方式,依次计算前向平面内机器人的落脚时间T f 和侧向平面内机器人的落脚时间T l ,比较两个落脚时间的大小,较小的落脚时间表示在不
进行额外干预的情况下,机器人在该平面内会率先着地,即在该平面内的步态可以优先进
行规划与控制,因此以较小落脚时间所在的平面作为优先平面并进一步进行平衡控制策略
的实施。
对于侧向平面,计算落脚时间T l 的方法如下。
首先规划侧向的ZMP偏移量。为了让机器人到达目标切换状态,需要对ZMP点进行规划,在计算落脚时间时也要考虑这一因素,因此需要提前规划好ZMP偏移量之后才能进一步计算得到该平面的落脚时间。
侧向的ZMP偏移量计算如下,
在此基础上计算侧向的落脚时间如下,
同理,计算前向的ZMP偏移量如下,
在此基础上计算前向的落脚时间如下,
如果T f ≥T l ,则选择侧向平面为优先平面,如果T f <T l ,则选择前向平面为优先平面。
步骤四:计算落脚位置
以侧向平面作为优先平面为例进行平衡控制策略说明,当前向平面为优先平面时同理。以侧向平面的落脚时间作为本次落脚控制的剩余摆动时间t t0= T l ,同时考虑侧向的ZMP偏移量z y ,计算在上述条件下机器人到达双足切换位置时的侧向速度如下:
并进一步计算落脚点侧向坐标如下,
进一步,计算非优先平面也就是前向平面的ZMP偏移量如下,
在此基础上,计算机器人到达双足切换位置时的前向速度如下,
最后计算落脚点的前向坐标如下,
当前向平面为优先平面时,同上述方法计算即可。
至此完成了以前向平面为优先平面的前向平面与侧向平面的ZMP规划与下一步的落脚点规划。基于上述结论,结合机器人本体的结构布局,选取通用的逆运动学解算方法,即可完成对机器人各个关节角度的实时规划计算,后续步骤在本发明中不进行详细说明。
以上实施例仅用于说明本发明的设计思想和特点,其目的在于使本领域内的技术人员能够了解本发明的内容并据以实施,本发明的保护范围不限于上述实施例。所以,凡依据本发明所揭示的原理、设计思路所作的等同变化或修饰,均在本发明的保护范围之内。
Claims (5)
1.一种双足机器人动态行走的平衡控制方法,其特征在于,包括以下步骤:
步骤一,获取双足机器人行走速度指令,并统一为二维的行走速度向量形式;
步骤二,对双足机器人规划理想步态,并根据步骤一获得的行走速度向量及机器人相
关信息计算获得双足机器人在完成当前步,并向下一步切换时的理想质心状态,其中,分别表示机器人在完成当前步,并向下一步切换时质心在x方向和y
方向的理想位置,分别表示机器人在完成当前步,并向下一步切换时质心在x方向和y方
向的理想速度;
步骤三,实时获取双足机器人的当前质心状态,其中, 分别表示当前
时刻机器人质心在x方向和y方向的位置, 分别表示当前时刻机器人质心在x方向和y
方向的速度;结合步骤二获取的双足机器人在完成当前步,并向下一步切换时的理想质心
状态依次计算前向平面内和侧向平面内机器人的落脚时间并确定优先平面;
步骤四,以优先平面的落脚时间作为本次落脚控制的剩余摆动时间,分别计算前向平面和侧向平面的落脚位置,从而实现存在外部扰动的情况下对落脚点的规划和平衡控制。
2.如权利要求1所述的一种双足机器人动态行走的平衡控制方法,其特征在于,所述步
骤二中,利用简化的三维倒立摆模型作为对象对双足机器人规划理想步态,根据步骤一获
得的行走速度向量及机器人相关信息计算获得双足机器人在完成当前步,并向下一步切换
时的理想质心状态具体如下:
其中,V x 为机器人向正前方的行走速度,V y 为向正左方的行走速度;V x max为机器人前向
行走速度最大值;为在侧向速度指令为V y 时,双足切换状态下的质心侧向位
置;为机器人质心在行走过程中距离支撑脚中心点最近点至双足切换状态
的时间;α为机器人质心在行走过程中距离支撑脚中心点最近时沿y轴方向的距离;δ为机器
人质心在双足切换状态时距离支撑脚中心点沿y轴方向的距离;σ为机器人质心距离支撑脚
中心点距离最近时沿x方向的行走速度;ω为机器人侧向行走速度为最大值V y max时,质心在
双足切换状态时距离支撑脚中心点沿y方向的距离;λϵ{-1,1}用于说明当前的双足支撑状
态;C为双足机器人的行走高度参数。
4.如权利要求1所述的一种双足机器人动态行走的平衡控制方法,其特征在于,所述步骤三中,确定优先平面具体为:选择落脚时间小对应的平面为优先平面。
5.如权利要求1所述的一种双足机器人动态行走的平衡控制方法,其特征在于,所述步骤四具体为:
以优先平面的落脚时间作为本次落脚控制的剩余摆动时间t t0,同时结合平面的ZMP偏移量,分别计算前向平面和侧向平面的落脚位置,结合机器人本体的结构布局,选取通用的逆运动学解算方法,完成对机器人各个关节角度的实时规划计算;其中,侧向平面的落脚位置计算方法如下:
进一步计算落脚点优先平面对应的坐标如下:
α为机器人质心在行走过程中距离支撑脚中心点最近时的沿y轴方向的距离;λϵ{-1,1}用于说明当前的双足支撑状态;
进一步计算双足机器人到达双足切换位置时的前向速度如下:
最后计算落脚点非优先平面对应的坐标如下:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111390083.6A CN113830197B (zh) | 2021-11-23 | 2021-11-23 | 一种应用于双足机器人动态行走的平衡控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111390083.6A CN113830197B (zh) | 2021-11-23 | 2021-11-23 | 一种应用于双足机器人动态行走的平衡控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113830197A CN113830197A (zh) | 2021-12-24 |
CN113830197B true CN113830197B (zh) | 2022-04-05 |
Family
ID=78971543
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111390083.6A Active CN113830197B (zh) | 2021-11-23 | 2021-11-23 | 一种应用于双足机器人动态行走的平衡控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113830197B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114115295B (zh) * | 2021-12-28 | 2023-08-18 | 深圳市优必选科技股份有限公司 | 机器人运动规划方法及装置、机器人控制设备和存储介质 |
CN114527663B (zh) * | 2022-02-24 | 2023-03-14 | 北京理工大学 | 基于变参数速度映射和二次规划的双足机器人落脚点规划方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103149933A (zh) * | 2013-02-27 | 2013-06-12 | 南京邮电大学 | 基于闭环控制的仿人机器人全向行走方法 |
CN111208826A (zh) * | 2020-02-18 | 2020-05-29 | 杭州云深处科技有限公司 | 四足机器人溜蹄步态规划方法、装置、设备及可读介质 |
CN111240339A (zh) * | 2020-02-11 | 2020-06-05 | 之江实验室 | 一种双足机器人的仿人步态规划方法 |
CN111353119A (zh) * | 2020-03-26 | 2020-06-30 | 北京理工大学 | 一种基于轨道机械能的双足行走稳定性分析方法 |
WO2020233050A1 (zh) * | 2019-11-26 | 2020-11-26 | 浙江大学 | 一种双足机器人不平整路面动态跑步步态实现方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111230868B (zh) * | 2020-01-19 | 2022-01-04 | 之江实验室 | 双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法 |
CN112091984B (zh) * | 2020-11-17 | 2021-04-20 | 深圳市优必选科技股份有限公司 | 双足机器人的步态纠偏方法、装置和计算机设备 |
-
2021
- 2021-11-23 CN CN202111390083.6A patent/CN113830197B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103149933A (zh) * | 2013-02-27 | 2013-06-12 | 南京邮电大学 | 基于闭环控制的仿人机器人全向行走方法 |
WO2020233050A1 (zh) * | 2019-11-26 | 2020-11-26 | 浙江大学 | 一种双足机器人不平整路面动态跑步步态实现方法 |
CN111240339A (zh) * | 2020-02-11 | 2020-06-05 | 之江实验室 | 一种双足机器人的仿人步态规划方法 |
CN111208826A (zh) * | 2020-02-18 | 2020-05-29 | 杭州云深处科技有限公司 | 四足机器人溜蹄步态规划方法、装置、设备及可读介质 |
CN111353119A (zh) * | 2020-03-26 | 2020-06-30 | 北京理工大学 | 一种基于轨道机械能的双足行走稳定性分析方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113830197A (zh) | 2021-12-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Kamedula et al. | On the kinematics of wheeled motion control of a hybrid wheeled-legged centauro robot | |
CN113830197B (zh) | 一种应用于双足机器人动态行走的平衡控制方法 | |
Zhou et al. | Overview of gait synthesis for the humanoid COMAN | |
WO2022156476A1 (zh) | 一种仿人机器人连续动态稳定跳跃控制方法 | |
CN113625735A (zh) | 基于腿臂复用六足机器人的控制方法和机器人 | |
CN112847371B (zh) | 一种仿人机器人动态跨越连续障碍物的运动规划方法 | |
Xu et al. | Obstacle-negotiation performance on challenging terrain for a parallel leg-wheeled robot | |
JP5639342B2 (ja) | ロボット及びその歩行制御方法 | |
Kumagai et al. | Efficient locomotion planning for a humanoid robot with whole-body collision avoidance guided by footsteps and centroidal sway motion | |
Mineshita et al. | Jumping motion generation for humanoid robot using arm swing effectively and changing in foot contact status | |
JP5310236B2 (ja) | 脚式ロボットとその制御方法 | |
Lu et al. | A novel multi-configuration quadruped robot with redundant DOFs and its application scenario analysis | |
Jianghai et al. | Walking pattern generation of biped robot using trajectory planning of gravity center | |
Moosavian et al. | Cartesian approach for gait planning and control of biped robots on irregular surfaces | |
Wu et al. | Quasi-static Walking for Biped Robots with a Sinusoidal Gait | |
Guan et al. | Motion planning for humanoid robots stepping over obstacles | |
Zhang et al. | Energy Efficiency and Speed Optimization by Squad-Unit Genetic Algorithm for Bipedal Walking | |
Yu et al. | Gait planning for biped robot based on variable center-of-mass height hybrid strategy | |
Hasunuma et al. | The tele-operation of the humanoid robot-whole body operation for humanoid robots in contact with environment | |
JP4311159B2 (ja) | ロボットの歩容データ作成装置及びシステム | |
CN114995476B (zh) | 一种步行机器人坡地崎岖地形的步态生成与姿态控制方法 | |
Wang et al. | Anti-push Method of Biped Robot Based on Motion Capture Point and Reinforcement Learning | |
Liu et al. | Humanoid Biped Robot Locomotion via Quadratic Programming with Compound Constraints | |
Hua et al. | Static gait control for quadruped robot | |
Zeng et al. | Overall Locomotion Control of a Quadruped Robot with Running Trot Gait |
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 |