CN112224300A - 一种用于双足机器人下台阶的稳定行走方法 - Google Patents

一种用于双足机器人下台阶的稳定行走方法 Download PDF

Info

Publication number
CN112224300A
CN112224300A CN202011473425.6A CN202011473425A CN112224300A CN 112224300 A CN112224300 A CN 112224300A CN 202011473425 A CN202011473425 A CN 202011473425A CN 112224300 A CN112224300 A CN 112224300A
Authority
CN
China
Prior art keywords
foot
robot
sensor
steps
center
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
Application number
CN202011473425.6A
Other languages
English (en)
Other versions
CN112224300B (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 Lab
Original Assignee
Zhejiang Lab
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 Lab filed Critical Zhejiang Lab
Priority to CN202011473425.6A priority Critical patent/CN112224300B/zh
Publication of CN112224300A publication Critical patent/CN112224300A/zh
Application granted granted Critical
Publication of CN112224300B publication Critical patent/CN112224300B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/024—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 specially adapted for moving on inclined or vertical surfaces
    • 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
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D21/00—Measuring or testing not otherwise provided for
    • G01D21/02—Measuring two or more variables by means not covered by a single other subclass
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01L—MEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/0028—Force sensors associated with force applying means
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • G01S15/06—Systems determining the position data of a target
    • G01S15/08—Systems for measuring distance only
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88—Sonar systems specially adapted for specific applications

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • General Physics & Mathematics (AREA)
  • Chemical & Material Sciences (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Acoustics & Sound (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Combustion & Propulsion (AREA)
  • Analytical Chemistry (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种用于双足机器人下台阶的稳定行走方法，采用该方法的双足机器人在台阶处下行行走时，可利用足部安装的各类传感器，快速获知台阶的边缘和高度信息，同时通过重心调整和足部动作，采用足部下探的方式行走，并根据足部传感器信息和下探结果实现重心移动和稳定台阶行走。该方法可有效避免双足机器人在遇到台阶下行等较危险地形时，难以获知准确台阶信息进行姿态调整而导致的机器人行走失稳甚至倾倒的现象。该方法使用足部进行台阶感知具有执行快速、运动准确、稳定可靠等特点，同时由于该方法主要依靠机器人足部，对具体构型无要求，适用于各类双足机器人，可显著改善机器人在台阶处的稳定行走能力。

Description

一种用于双足机器人下台阶的稳定行走方法
技术领域
本发明属于机器人技术领域，尤其涉及一种用于双足机器人下台阶的稳定行走方法。
背景技术
双足机器人是一种使用腿足式身体结构和仿人步态行走的机器人，其优势在于双足行走带来的多种地形行走能力和强大运动能力，区别于轮式运动机器人，其在台阶、沟坎等非平整地形处仍可保持较强的通过能力。目前的双足机器人已实现在平整路面上的稳定行走，部分双足机器人在遇到低矮障碍时已具备一定的越障能力，在上台阶行走时也可通过视觉、激光等传感信息，配合一定的策略完成部分上台阶行走。但在下台阶行走时，由于视角等原因，台阶的高度等地形信息并不处于视觉和激光等传感器的感知范围内，且由于部分台阶的高度差较小，极易造成机器人视觉系统的误判，导致机器人未能及时采取阶梯行走的控制策略，从而造成机器人的倾倒，此时由于机器人正处于下楼状态，倾倒现象的发生将造成机器人的严重损坏。部分采用视觉推测式判断阶梯地形信息的方法难以获得较为准确的台阶信息，在下台阶时足部和踝关节处受到的冲击较大，极易造成该部分损坏。同时由于机器人的足部运动与重心移动同步进行，若重心调整不及时，足部触地时重心未能落于台阶支撑平面内，机器人也将发生倾倒现象，难以保持平衡。
中国专利号CN105074600A公开的一种机器人周围环境识别装置、自主移动系统以及周围环境识别方法，采用视觉和距离传感器探测机器人前方地形，通过算法生成地面三维坐标数据，从而判断机器人前方是否存在台阶等障碍物。该方法可以实现机器人前方障碍的快速判断，但该方法仅对台阶等障碍物作出了位置判断，主要用于轮式机器人的避障等，无法满足腿足式机器人对台阶等障碍物具体信息的获知要求。
中国专利号CN104002880A公开的一种带有导臂的履带式移动机器人自主上下楼梯控制方法采用履带结构实现机器人的上下楼梯功能，采用双目视觉传感器和三轴力传感器实现楼梯位置判断和自动对准。该方法可实现一定程度上的楼梯运动，但采用视觉和力传感器仍无法获知台阶的准确信息，只能依靠履带的自适应性进行上下阶梯运动，机器人整体缺乏稳定行，控制难度高，且该方法对楼梯的陡峭程度作出了限制，只适用于较为平缓的台阶上，无法满足腿足式机器人对台阶行走能力的要求。
中国专利号CN102324099A公开的一种面向仿人机器人的台阶边缘检测方法采用视觉传感和图像处理的方式，得到了较为准确的台阶边缘信息，并通过对算法的优化，满足了机器人视觉实时性和精确性的要求。利用该方法可以获取到台阶边缘信息，但对于需要下台阶行走的腿足式机器人而言，台阶的高度等具体信息是必须的，且在无足部传感器信号反馈的前提下，机器人难以保证在落足时的稳定性。
发明内容
本发明的目的在于针对现有技术的不足，提供一种用于双足机器人下台阶的稳定行走方法。本发明利用机器人足部的传感器，结合机器人视觉信息提前快速获知机器人所处台阶的具体地形信息，使得机器人提前作出判断，并进行相应步态调整；同时采用足部下探式行走方式获得实际台阶接触情况后再执行进一步行走命令，保证机器人在台阶等小触地面积地面行走时的稳定性；主要利用机器人足部的感知能力，适用于各类腿足式机器人，具有执行快速、运动准确、稳定可靠等特点。
本发明的目的是通过以下技术方案来实现的：一种用于双足机器人下台阶的稳定行走方法，所述双足机器人利用机器人台阶地形传感足部安装的传感器，辅以视觉传感器完成台阶地形的快速检测，并通过控制足部的下探过程和重心移动过程，完成机器人的平稳落地；机器人台阶地形传感足部包括足底触地层、中间感知层和上部运动层，所述足底触地层包含柔性缓冲减震部件和超声波距离传感器阵列，超声波距离传感器的数量和位置依照实际足部大小和形状确定；所述中间感知层包含足底压力传感器阵列，压力传感器的数量和位置依照实际足部大小和形状确定；所述上部运动层包含足部主体结构、二自由度踝关节、足部传感器处理电路；足部结构的整体形状为平板式，行走方式为足底平行于地面的踏步式步态。
进一步地，在台阶感知过程中，足部超声波距离传感器随足部运动，在部分或全部探出台阶时，持续探测并返回足底距离地面的高度，由不同传感器返回的距离信息获知台阶的高度差为：
Figure 955761DEST_PATH_IMAGE001
其中，
Figure 279426DEST_PATH_IMAGE002
为该级台阶高度差，
Figure 292119DEST_PATH_IMAGE003
为探出台阶传感器返回的距离值，
Figure 93853DEST_PATH_IMAGE004
为探出台阶传感 器的数量，
Figure 439384DEST_PATH_IMAGE005
为未探出台阶传感器返回的距离值，
Figure 402792DEST_PATH_IMAGE006
为未探出台阶传感器的数量。
进一步地，足部超声波距离传感器随足部运动，当传感器越过台阶边缘时，返回的距离传感数值将产生显著变化，根据传感器在足部的安装位置，以及足部运动速度，获知并修正台阶边缘的位置为：
Figure 200984DEST_PATH_IMAGE007
其中，
Figure 806408DEST_PATH_IMAGE008
为传感器
Figure 6446DEST_PATH_IMAGE009
测得的台阶边缘与足部未向前移动前足部中心初始位置的距离，
Figure 907799DEST_PATH_IMAGE010
为足部向前移动的速度，
Figure 193287DEST_PATH_IMAGE011
为传感器
Figure 133561DEST_PATH_IMAGE009
返回的距离值发生显著变化的时间，
Figure 63471DEST_PATH_IMAGE012
为传感器
Figure 24474DEST_PATH_IMAGE009
与足部中心在足长方向上的距离，
Figure 407044DEST_PATH_IMAGE013
为由探出台阶传感器测得值线性回归得到 的台阶边缘直线的表达式。
进一步地，足部超声波距离传感器和足底压力传感器在足部下探的过程中，根据安装于足部各处的传感器返回的不同数据，进一步探知该级台阶的宽度为：
Figure 213326DEST_PATH_IMAGE014
其中，
Figure 761857DEST_PATH_IMAGE015
为由超声波距离传感器测得值线性回归得到的该级台阶边 缘直线的表达式，
Figure 628182DEST_PATH_IMAGE016
为由超声波距离传感器测得值线性回归得到的下一 级台阶边缘直线的表达式，
Figure 763628DEST_PATH_IMAGE017
为该级台阶的宽度。
进一步地，机器人重心在足部伸出进行下探之前，移动至用于站立的支撑足，并在感知足部伸出台阶及下探的过程中，保持机器人重心的投影始终落于支撑足部与地面的接触平面内，即
Figure 373601DEST_PATH_IMAGE018
其中，
Figure 278103DEST_PATH_IMAGE019
为机器人重心在脚宽方向上的投影，
Figure 580909DEST_PATH_IMAGE020
为足部中心在脚宽方向上的坐标，
Figure 938072DEST_PATH_IMAGE021
为足部宽度，
Figure 351736DEST_PATH_IMAGE022
为机器人重心在脚长方向上的投影，
Figure 623928DEST_PATH_IMAGE023
为足部中心在脚长方向上的 坐标，
Figure 769738DEST_PATH_IMAGE024
为足部长度。
进一步地，机器人用于台阶感知的足部在下探的过程中，参照超声波和力传感器信息得到的台阶高度差和边缘位置，依据一定的移动策略进行快速稳定的下探过程，该移动策略表示为：
Figure 738831DEST_PATH_IMAGE025
其中，
Figure 565973DEST_PATH_IMAGE026
为足部下探的实际速度，
Figure 304122DEST_PATH_IMAGE027
为足部下探的最大速度；
Figure 355255DEST_PATH_IMAGE028
为超声波传感器测得 的足部与台阶间的实际距离，
Figure 185545DEST_PATH_IMAGE002
为测得的台阶高度差；
Figure 941011DEST_PATH_IMAGE029
、
Figure 409033DEST_PATH_IMAGE030
、
Figure 224542DEST_PATH_IMAGE031
为足部下探速度系数，使 得下探速度由快到慢，由机器人设计参数和运动能力决定。
进一步地，机器人用于台阶感知的足部在下探触及地面时，根据超声波和压力传感器信息，获得稳定落地的足部支撑范围和足部姿态为：
Figure 43594DEST_PATH_IMAGE032
其中，
Figure 602751DEST_PATH_IMAGE033
为由超声波传感器测得值线性回归得到的第j级台阶边缘直线的 表达式，
Figure 190858DEST_PATH_IMAGE019
为机器人重心在脚宽方向上的投影，
Figure 911690DEST_PATH_IMAGE020
为足部中心在脚宽方向上的坐标，
Figure 516240DEST_PATH_IMAGE021
为足部宽度，
Figure 488875DEST_PATH_IMAGE022
为机器人重心在脚长方向上的投影，
Figure 524964DEST_PATH_IMAGE023
为足部中心在脚长方向上的坐 标，
Figure 416697DEST_PATH_IMAGE024
为足部长度。
进一步地，机器人获得完整台阶感知信息和稳定落地信息后，将重心移动至已位于下一级台阶上的足部稳定支撑平面内，并切换该足部为支撑足，另一足部为下一级台阶的感知足部。
本发明的有益效果如下：
（1）本发明适用于各种构型的双足机器人，仅对足部结构有一定要求，具有较强的通用性。利用双足机器人腿足运动较为灵活的特点，使用足部进行台阶感知具有执行快速、运动准确、稳定可靠等特点；
（2）足部的下探式台阶行走方式保证了机器人在下台阶行走时重心始终落于稳定支撑区域内，避免了倾倒现象的发生。同时足部的台阶感知和稳定行走控制过程相结合，在一次步行流程内同时完成两项任务，使得双足机器人的下台阶步行过程同时具有较高的效率和较好的稳定性。
附图说明
图1是本发明实施例的立体结构示意图；
图2是本发明实施例的侧视图；
附图标号：1-足底触地层；101-柔性缓冲减震部件；102-超声波距离传感器阵列；2-中间感知层；201-压力传感器阵列；3-上部运动层；301-足部主体；302-二自由度踝关节；303-传感器处理电路。
具体实施方式
以下结合附图对本发明作进一步说明。
本发明的技术构思在于：针对双足机器人下台阶行走的难点提出了一种快速稳定的解决方案，充分利用足部运动的灵活性和各类传感器，克服了传统仅依靠视觉进行路面地形判断所带来的不足，将整个足部变为具有台阶感知能力的一套系统，安装各类用于检测和探知台阶信息的传感器阵列，保证双足机器人原有足部功能不受影响的同时，有效提升了机器人在下台阶时对于台阶具体地形信息的感知准确度和可靠性。本发明将传统被动式台阶感知适应过程变为主动式探知过程，在传统视觉信息中加入了距离和力反馈信息，使感知过程更加可靠。在足部运动并感知台阶信息的同时，本发明提供的双足机器人台阶稳定行走方式，所述双足机器人将控制重心移动和各部位姿态，以确保机器人在下台阶行走和台阶处站立时的自身稳定，可有效避免机器人在下台阶过程中，由于重心位置不正确或姿态控制不正确等问题而导致的倾倒现象。本发明将传统足部与重心同时移动的行走方式更改为适合下台阶行走的重心后动方式，可有效提升双足机器人台阶行走的稳定性。本发明利用足部感知获得的台阶具体信息，结合稳定行走方式，使得双足机器人可以可靠地完成下台阶行走。
本发明一种用于双足机器人下台阶的稳定行走方法，主要利用机器人台阶地形传感足部安装的传感器，辅以原有视觉传感器完成台阶地形的快速检测；并通过控制足部的下探过程和重心移动过程，完成机器人的平稳落地。机器人获得完整台阶感知信息和稳定落地信息后，将重心移动至已位于下一级台阶上的足部稳定支撑平面内，并切换该足部为支撑足，另一足部则变为下一级台阶的感知足部。
参照图1，本发明中机器人台阶地形传感足部主要包括足底触地层1、中间感知层2和上部运动层3。足底触地层1主要包含柔性缓冲减震部件101和超声波距离传感器阵列102，超声波距离传感器的数量和位置依照实际足部大小和形状确定。中间感知层2主要包含压力传感器阵列201，压力传感器的数量和位置依照实际足部大小和形状确定。上部运动层3主要包含足部主体301、二自由度踝关节302、足部传感器处理电路303。如图2所示，机器人台阶地形传感足部结构的整体形状为平板式，行走方式主要为足底平行于地面的踏步式步态。
本发明一种双足机器人下台阶的快速检测方法，包括获知台阶的高度差、获知并修正台阶边缘位置和探知台阶的宽度，具体为：
（a）首先机器人视觉系统根据图像初步检测出台阶边缘位置供参考，该步骤主要用于在远距离对台阶进行识别定位，起辅助作用，精度要求不高，机器人可利用该结果快速接近台阶所在位置，之后再使用本发明提供的更为快速和精确的检测方法。
在台阶感知过程中，所述超声波距离传感器阵列102随足部运动，在部分或全部探 出台阶时，将持续探测并返回足底距离地面的高度；由探出台阶传感器返回的距离信息
Figure 210340DEST_PATH_IMAGE003
、 探出台阶传感器数量
Figure 111300DEST_PATH_IMAGE004
、未探出台阶传感器返回的距离信息
Figure 205158DEST_PATH_IMAGE005
以及未探出台阶传感器数量
Figure 907273DEST_PATH_IMAGE006
，可获知台阶的高度差
Figure 250529DEST_PATH_IMAGE002
为：
Figure 627284DEST_PATH_IMAGE034
（b）持续采集超声波距离传感器阵列102的数据，由于超声波距离传感器阵列102随足 部运动，当传感器越过台阶边缘时，返回的距离传感数值将产生显著变化。以某一超声波传 感器
Figure 903545DEST_PATH_IMAGE009
为例，根据足部向前移动的速度
Figure 278025DEST_PATH_IMAGE035
，传感器
Figure 905316DEST_PATH_IMAGE009
返回的距离值发生显著变化 的时间
Figure 23444DEST_PATH_IMAGE036
，以足部中心为原点，足部运动方向为y轴，垂直于足部运动方向为x轴，传 感器
Figure 419791DEST_PATH_IMAGE009
与足部中心在足长方向上的距离
Figure 263375DEST_PATH_IMAGE037
，传感器
Figure 581224DEST_PATH_IMAGE009
测得的台阶边缘与未移动前足 部中心的距离
Figure 237464DEST_PATH_IMAGE008
和台阶边缘直线表达式
Figure 753896DEST_PATH_IMAGE038
为：
Figure 470180DEST_PATH_IMAGE039
其中，距离
Figure 744166DEST_PATH_IMAGE012
有正负，若机器人前向行走，则足前掌所在的一半传感器
Figure 328731DEST_PATH_IMAGE012
为正，足后跟 所在的一半传感器
Figure 73571DEST_PATH_IMAGE012
为负。
Figure 85389DEST_PATH_IMAGE040
为由探出台阶传感器测得值线性回归得到的 台阶边缘直线的表达式，此处利用两级台阶的高度变化，当距离传感器探出某一级台阶时， 其读数会发生显著变化，利用时间参数，以及传感器安装位置和足部移动速度等参数，由移 动过程中距离传感器阵列获得的数据，采用统计学方法，利用线性回归方式拟合得到台阶 边缘直线表达式。
（c）超声波距离传感器阵列102和压力传感器阵列201在足部下探的过程中，根据 超声波距离传感器测得值线性回归得到的该级台阶边缘直线的表达式
Figure 518776DEST_PATH_IMAGE041
，以及由超声波距离传感器测得值线性回归得 到的下一级台阶边缘直线的表达式
Figure 907032DEST_PATH_IMAGE042
，可进一步探 知该级台阶的宽度
Figure 804581DEST_PATH_IMAGE017
为：
Figure 862667DEST_PATH_IMAGE043
本发明一种用于双足机器人下台阶的稳定行走方法，包括以下步骤：
（1）机器人重心在足部伸出进行下探之前，移动至用于站立的支撑足，并在感知足部伸 出台阶及下探的过程中，保持机器人重心的投影始终落于支撑足部与地面的接触平面内。 若已知足部中心在脚宽方向上的坐标
Figure 81552DEST_PATH_IMAGE044
，足部宽度
Figure 7920DEST_PATH_IMAGE045
，足部中心在脚 长方向上的坐标
Figure 963237DEST_PATH_IMAGE046
，以及足部长度
Figure 582437DEST_PATH_IMAGE047
，则机器人重心在脚宽方向上的投 影
Figure 52733DEST_PATH_IMAGE019
和机器人重心在脚长方向上的投影
Figure 658158DEST_PATH_IMAGE022
须满足：
Figure 795878DEST_PATH_IMAGE048
（2）足部在下探时，参照台阶高度差
Figure 585980DEST_PATH_IMAGE002
和台阶边缘位置，将下探过程分成三段，每一 段的下探速度不同且由快到慢，进行快速稳定的下探过程，具体为：已知足部下探的最大速 度
Figure 245369DEST_PATH_IMAGE049
，测得的台阶高度差
Figure 513539DEST_PATH_IMAGE050
，由机器人设计参数和运动能力决定的足部 下探速度系数
Figure 443449DEST_PATH_IMAGE051
，以及超声波距离传感器阵列102测得的足部与 台阶间的实际距离
Figure 404452DEST_PATH_IMAGE028
，则足部下探的实际速度
Figure 787023DEST_PATH_IMAGE026
的变化策略为：
Figure 858884DEST_PATH_IMAGE052
（3）足部在下探触及地面时，根据超声波距离传感器阵列102和压力传感器阵列201信 息，获得可以稳定落地的足部支撑范围和足部姿态，具体为：已知由传感器测得值线性回归 得到的该级台阶j边缘直线的表达式
Figure 174459DEST_PATH_IMAGE053
，足部中心在脚宽方向上 的坐标
Figure 775204DEST_PATH_IMAGE044
，足部宽度
Figure 400397DEST_PATH_IMAGE045
，足部中心在脚长方向上的坐标
Figure 275949DEST_PATH_IMAGE046
， 足部长度
Figure 180451DEST_PATH_IMAGE047
，则机器人重心在脚宽方向上的投影
Figure 217677DEST_PATH_IMAGE019
和机器人重心在脚长方向上 的投影
Figure 574840DEST_PATH_IMAGE022
须满足：
Figure 254083DEST_PATH_IMAGE054
上述实施例仅仅是本发明技术构思实现形式的列举，本发明的保护范围不仅限于上述实施例，本发明的保护范围可延伸至本领域技术人员根据本发明的技术构思所能想到的等同技术手段。

Claims (9)

1.一种用于双足机器人下台阶的稳定行走方法，所述双足机器人的足部包括足底触地层和中间感知层，所述足底触地层包含超声波距离传感器阵列；所述中间感知层包含压力传感器阵列；所述双足机器人的足底为平面，行走方式为足底平行于地面的踏步式步态；其特征在于，所述稳定行走方法包括以下步骤：
（1）利用超声波距离传感器阵列，并辅以视觉传感器进行台阶感知，完成双足机器人下台阶的快速检测，包括以下子步骤：
（1.1）通过双足机器人的视觉传感器获得初始的台阶边缘位置，足部靠近台阶；
（1.2）获知台阶的高度差：由足底探出台阶的超声波距离传感器测量值和未探出台阶的超声波距离传感器测量值之差得到台阶的高度差；
（1.3）修正台阶边缘位置：由超声波距离传感器阵列中探出台阶的超声波距离传感器和未探出台阶的超声波距离传感器的交界处拟合得到台阶边缘位置拟合直线，作为修正后的台阶边缘位置；
（1.4）获知台阶的宽度：根据步骤（1.3）修正后的台阶边缘位置，所述台阶的宽度为相邻两台阶边缘位置的距离；
（2）根据步骤（1）获得台阶感知信息后，利用超声波距离传感器阵列和压力传感器阵列，控制足部的下探过程和重心移动过程，完成双足机器人下台阶的稳定行走，包括以下子步骤：
（2.1）足部的下探过程中，根据步骤（1）获得台阶感知信息，足部靠近台阶，根据超声波距离传感器测量值，足底靠近台阶过程中下探速度由快到慢；
（2.2）足部的重心移动过程中，机器人重心的投影始终落于支撑足部与地面的接触平面内，接触平面根据压力传感器阵列得到。
2.根据权利要求1所述用于双足机器人下台阶的稳定行走方法，其特征在于，在台阶感知过程中，足部超声波距离传感器随足部运动，在部分或全部探出台阶时，持续探测并返回足底距离地面的高度，由不同传感器返回的距离信息获知台阶的高度差为：
Figure 567215DEST_PATH_IMAGE001
其中，
Figure 40921DEST_PATH_IMAGE002
为该级台阶高度差，
Figure 885381DEST_PATH_IMAGE003
为探出台阶传感器返回的距离值，
Figure 837156DEST_PATH_IMAGE004
为探出台阶传感 器的数量，
Figure 716250DEST_PATH_IMAGE005
为未探出台阶传感器返回的距离值，
Figure 95279DEST_PATH_IMAGE006
为未探出台阶传感器的数量。
3.根据权利要求2所述用于双足机器人下台阶的稳定行走方法，其特征在于，足部超声波距离传感器随足部运动，当传感器越过台阶边缘时，返回的距离传感数值将产生显著变化，根据传感器在足部的安装位置，以及足部运动速度，获知并修正台阶边缘的位置为：
Figure 940218DEST_PATH_IMAGE007
其中，
Figure 695684DEST_PATH_IMAGE008
为传感器
Figure 429285DEST_PATH_IMAGE009
测得的台阶边缘与足部未向前移动前足部中心初始位置的距离，
Figure 244794DEST_PATH_IMAGE010
为足部向前移动的速度，
Figure 329425DEST_PATH_IMAGE011
为传感器
Figure 357424DEST_PATH_IMAGE009
返回的距离值发生显著变化的时间，
Figure 476690DEST_PATH_IMAGE012
为传感器
Figure 837002DEST_PATH_IMAGE009
与足部中心在足长方向上的距离，
Figure 533562DEST_PATH_IMAGE013
为由探出台阶传感器测得值线性回归得到 的台阶边缘直线的表达式。
4.根据权利要求3所述用于双足机器人下台阶的稳定行走方法，其特征在于，足部超声波距离传感器和足底压力传感器在足部下探的过程中，根据安装于足部各处的传感器返回的不同数据，进一步探知该级台阶的宽度为：
Figure 506197DEST_PATH_IMAGE014
其中，
Figure 73445DEST_PATH_IMAGE015
为由超声波距离传感器测得值线性回归得到的该级台阶边 缘直线的表达式，
Figure 106123DEST_PATH_IMAGE016
为由超声波距离传感器测得值线性回归得到的下一 级台阶边缘直线的表达式，
Figure 24401DEST_PATH_IMAGE017
为该级台阶的宽度。
5.根据权利要求4所述用于双足机器人下台阶的稳定行走方法，其特征在于，机器人重心在足部伸出进行下探之前，移动至用于站立的支撑足，并在感知足部伸出台阶及下探的过程中，保持机器人重心的投影始终落于支撑足部与地面的接触平面内，即
Figure 535147DEST_PATH_IMAGE018
其中，
Figure 222481DEST_PATH_IMAGE019
为机器人重心在脚宽方向上的投影，
Figure 753956DEST_PATH_IMAGE020
为足部中心在脚宽方向上的坐标，
Figure 67519DEST_PATH_IMAGE021
为足部宽度，
Figure 647536DEST_PATH_IMAGE022
为机器人重心在脚长方向上的投影，
Figure 392638DEST_PATH_IMAGE023
为足部中心在脚长方向上的 坐标，
Figure 891753DEST_PATH_IMAGE024
为足部长度。
6.根据权利要求5所述用于双足机器人下台阶的稳定行走方法，其特征在于，机器人用于台阶感知的足部在下探的过程中，参照超声波和力传感器信息得到的台阶高度差和边缘位置，依据一定的移动策略进行快速稳定的下探过程，该移动策略表示为：
Figure 394409DEST_PATH_IMAGE025
其中，
Figure 371593DEST_PATH_IMAGE026
为足部下探的实际速度，
Figure 908884DEST_PATH_IMAGE027
为足部下探的最大速度；
Figure 578900DEST_PATH_IMAGE028
为超声波传感器测得的 足部与台阶间的实际距离，
Figure 67388DEST_PATH_IMAGE002
为测得的台阶高度差；
Figure 113842DEST_PATH_IMAGE029
、
Figure 240061DEST_PATH_IMAGE030
、
Figure 80978DEST_PATH_IMAGE031
为足部下探速度系数，使得 下探速度由快到慢，由机器人设计参数和运动能力决定。
7.根据权利要求6所述用于双足机器人下台阶的稳定行走方法，其特征在于，机器人用于台阶感知的足部在下探触及地面时，根据超声波和压力传感器信息，获得稳定落地的足部支撑范围和足部姿态为：
Figure 558226DEST_PATH_IMAGE032
其中，
Figure 142792DEST_PATH_IMAGE033
为由超声波传感器测得值线性回归得到的第j级台阶边缘直线的表 达式，
Figure 389096DEST_PATH_IMAGE019
为机器人重心在脚宽方向上的投影，
Figure 666494DEST_PATH_IMAGE020
为足部中心在脚宽方向上的坐标，
Figure 601345DEST_PATH_IMAGE021
为 足部宽度，
Figure 989601DEST_PATH_IMAGE022
为机器人重心在脚长方向上的投影，
Figure 355992DEST_PATH_IMAGE023
为足部中心在脚长方向上的坐标，
Figure 538711DEST_PATH_IMAGE024
为足部长度。
8.根据权利要求7所述用于双足机器人下台阶的稳定行走方法，其特征在于，机器人获得完整台阶感知信息和稳定落地信息后，将重心移动至已位于下一级台阶上的足部稳定支撑平面内，并切换该足部为支撑足，另一足部为下一级台阶的感知足部。
9.根据权利要求1所述用于双足机器人下台阶的稳定行走方法，其特征在于，所述双足机器人的足部包括足底触地层、中间感知层和上部运动层，所述足底触地层包含柔性缓冲减震部件和超声波距离传感器阵列，超声波距离传感器的数量和位置依照实际足部大小和形状确定；所述中间感知层包含足底压力传感器阵列，压力传感器的数量和位置依照实际足部大小和形状确定；所述上部运动层包含足部主体结构、二自由度踝关节、足部传感器处理电路；足部结构的整体形状为平板式。
CN202011473425.6A 2020-12-15 2020-12-15 一种用于双足机器人下台阶的稳定行走方法 Active CN112224300B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011473425.6A CN112224300B (zh) 2020-12-15 2020-12-15 一种用于双足机器人下台阶的稳定行走方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011473425.6A CN112224300B (zh) 2020-12-15 2020-12-15 一种用于双足机器人下台阶的稳定行走方法

Publications (2)

Publication Number Publication Date
CN112224300A true CN112224300A (zh) 2021-01-15
CN112224300B CN112224300B (zh) 2021-03-30

Family

ID=74124203

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011473425.6A Active CN112224300B (zh) 2020-12-15 2020-12-15 一种用于双足机器人下台阶的稳定行走方法

Country Status (1)

Country Link
CN (1) CN112224300B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113172635A (zh) * 2021-06-09 2021-07-27 乐聚(深圳)机器人技术有限公司 双足机器人行走控制方法、装置、设备及存储介质

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60215480A (ja) * 1984-04-12 1985-10-28 Toshiba Corp 走行車
WO2001094185A1 (fr) * 2000-06-09 2001-12-13 Shimadzu Mectem, Inc. Chariot monte-escaliers
CN1419103A (zh) * 2002-12-17 2003-05-21 北京航空航天大学 提高激光外差差分干涉仪定位精度的装置及方法
CN103963865A (zh) * 2014-05-08 2014-08-06 南通大学 升降伸缩式楼道清洁机器人上下楼梯的判别方法
CN106527449A (zh) * 2016-12-23 2017-03-22 上海木爷机器人技术有限公司 避障系统
CN108263275A (zh) * 2016-12-31 2018-07-10 青岛翰兴知识产权运营管理有限公司 一种基于双传感器探测的车辆辅助驾驶预警方法
CN108706060A (zh) * 2018-06-26 2018-10-26 石高荣 智能爬楼车
CN209662014U (zh) * 2018-12-20 2019-11-22 付春林 一种全地形智能机器人轮椅车

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60215480A (ja) * 1984-04-12 1985-10-28 Toshiba Corp 走行車
WO2001094185A1 (fr) * 2000-06-09 2001-12-13 Shimadzu Mectem, Inc. Chariot monte-escaliers
CN1419103A (zh) * 2002-12-17 2003-05-21 北京航空航天大学 提高激光外差差分干涉仪定位精度的装置及方法
CN103963865A (zh) * 2014-05-08 2014-08-06 南通大学 升降伸缩式楼道清洁机器人上下楼梯的判别方法
CN106527449A (zh) * 2016-12-23 2017-03-22 上海木爷机器人技术有限公司 避障系统
CN108263275A (zh) * 2016-12-31 2018-07-10 青岛翰兴知识产权运营管理有限公司 一种基于双传感器探测的车辆辅助驾驶预警方法
CN108706060A (zh) * 2018-06-26 2018-10-26 石高荣 智能爬楼车
CN209662014U (zh) * 2018-12-20 2019-11-22 付春林 一种全地形智能机器人轮椅车

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113172635A (zh) * 2021-06-09 2021-07-27 乐聚(深圳)机器人技术有限公司 双足机器人行走控制方法、装置、设备及存储介质

Also Published As

Publication number Publication date
CN112224300B (zh) 2021-03-30

Similar Documents

Publication Publication Date Title
US11123869B2 (en) Robotically negotiating stairs
US11225294B1 (en) Mechanically-timed footsteps for a robotic device
US10300969B1 (en) Slip detection for robotic locomotion
KR101111714B1 (ko) 각식 로봇 및 각식 로봇의 제어방법
US9387896B1 (en) Slip avoidance
US9387588B1 (en) Handling gait disturbances with asynchronous timing
US7664572B2 (en) Control device of legged mobile robot
US9446518B1 (en) Leg collision avoidance in a robotic device
Kang et al. Realization of biped walking on uneven terrain by new foot mechanism capable of detecting ground surface
US9964956B2 (en) Operating environment information generating device for mobile robot
CN112224300B (zh) 一种用于双足机器人下台阶的稳定行走方法
US6177776B1 (en) Apparatus for recognizing the landed state of foot of legged moving robot
Rogelio Guadarrama Olvera et al. Plantar tactile feedback for biped balance and locomotion on unknown terrain
CN116449711A (zh) 可跨越大障碍物的四足机器人爬行态规划方法及系统
KR100904769B1 (ko) 진로 방해물 감지 장치 및 방법
JP2007007803A (ja) ロボットとその制御方法
JP2013208294A (ja) 歩行装置、及び歩行プログラム
TWI773947B (zh) 控制裝置、外骨骼系統及控制方法
JP2009184035A (ja) 脚式ロボット、及びその制御方法
KR101820775B1 (ko) 로봇 발 착지 제어시스템
JP4696728B2 (ja) 脚式ロボットとその制御方法
JP2001353686A (ja) 脚式移動ロボットのための足部構造、並びに路面検知装置
Hashimoto et al. Terrain-adaptive control with small landing impact force for biped vehicle
CN215322948U (zh) 足式机器人及足式机器人的足部
JP2010260153A (ja) 脚式ロボット

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