CN113359800A - 机器人行走控制方法、装置、机器人控制设备及存储介质 - Google Patents
机器人行走控制方法、装置、机器人控制设备及存储介质 Download PDFInfo
- Publication number
- CN113359800A CN113359800A CN202110739449.XA CN202110739449A CN113359800A CN 113359800 A CN113359800 A CN 113359800A CN 202110739449 A CN202110739449 A CN 202110739449A CN 113359800 A CN113359800 A CN 113359800A
- Authority
- CN
- China
- Prior art keywords
- expected
- robot
- biped robot
- track
- walking
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 65
- 230000008569 process Effects 0.000 claims abstract description 21
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 16
- 210000000544 articulatio talocruralis Anatomy 0.000 claims description 77
- 210000002683 foot Anatomy 0.000 claims description 71
- 230000033001 locomotion Effects 0.000 claims description 62
- 238000004590 computer program Methods 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 8
- 230000006978 adaptation Effects 0.000 claims description 5
- 230000003044 adaptive effect Effects 0.000 claims description 5
- 210000003414 extremity Anatomy 0.000 claims description 4
- 239000013256 coordination polymer Substances 0.000 claims 6
- 238000010586 diagram Methods 0.000 description 16
- 238000004891 communication Methods 0.000 description 13
- 230000006870 function Effects 0.000 description 12
- 210000003423 ankle Anatomy 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 239000000470 constituent Substances 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012876 topography Methods 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Abstract
本申请提供一种机器人行走控制方法、装置、机器人控制设备及存储介质,涉及机器人控制技术领域。本申请在获取到双足机器人当前的平地行走规划轨迹以及该双足机器人当前所在斜坡的目标坡度角后,会基于目标坡度角对平地行走规划轨迹中的腿部摆动规划轨迹进行适配调整,得到腿部摆动期望轨迹,并基于目标坡度角对平地行走规划轨迹中的质心位置规划轨迹进行参数补偿,得到质心位置期望轨迹,而后基于机器人逆运动学算法计算同时与腿部摆动期望轨迹及质心位置期望轨迹匹配的期望驱动参数,接着采用期望驱动参数控制双足机器人进行运动,使双足机器人在平地行走过程中遇到斜坡地形时平稳地行走在对应坡面上,以提升双足机器人的行走稳定性。
Description
技术领域
本申请涉及机器人控制技术领域,具体而言,涉及一种机器人行走控制方法、装置、机器人控制设备及存储介质。
背景技术
随着科学技术的不断发展,机器人技术因具有极大的研究价值及应用价值受到了各行各业的广泛重视,其中双足机器人控制便是机器人控制技术领域中的一项重要研究方向。而在按照预先规划好的平地行走轨迹控制双足机器人运动的过程中,往往会因选定地面本身存在不同程度的斜坡地形的环境客观因素影响双足机器人的行走稳定性。
发明内容
有鉴于此,本申请的目的在于提供一种机器人行走控制方法、装置、机器人控制设备及存储介质,能够使双足机器人在平地行走过程中遇到斜坡地形的情况下能平稳地行走在对应坡面上,防止双足机器人摔倒,提升双足机器人的行走稳定性。
为了实现上述目的,本申请实施例采用的技术方案如下:
第一方面,本申请提供一种机器人行走控制方法,所述方法包括:
获取双足机器人当前的平地行走规划轨迹,以及所述双足机器人当前所在斜坡的目标坡度角,其中所述平地行走规划轨迹包括所述双足机器人平地行走时的腿部摆动规划轨迹及质心位置规划轨迹;
根据所述目标坡度角对所述腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹;
根据所述目标坡度角对所述质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹;
基于机器人逆运动学算法计算同时与所述腿部摆动期望轨迹及所述质心位置期望轨迹匹配的期望驱动参数;
按照所述期望驱动参数控制所述双足机器人进行运动,使所述双足机器人在对应斜坡上行走。
在可选的实施方式中,所述根据所述目标坡度角对所述腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹的步骤,包括:
根据所述目标坡度角及所述腿部摆动规划轨迹包括的规划步长,计算所述双足机器人当前在对应斜坡上的摆动腿抬腿位置与摆动腿落点位置之间的期望迈步距离及期望落足高度变化量;
采用所述期望落足高度变化量对所述腿部摆动规划轨迹包括的规划抬腿高度进行补偿,得到所述双足机器人当前在对应斜坡上的期望抬腿高度;
根据所述期望迈步距离及所述期望抬腿高度规划形成对应的腿部摆动期望轨迹。
在可选的实施方式中,所述根据所述目标坡度角对所述质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹的步骤,包括:
根据所述双足机器人的从踝关节到足底之间的肢体高度以及所述目标坡度角,计算所述双足机器人当前的质心前移补偿量;
采用所述质心前移补偿量对所述质心位置规划轨迹包括的质心前移规划位置进行补偿,并采用所述期望落足高度变化量对所述质心位置规划轨迹包括的质心高度规划位置进行补偿,得到对应的质心位置期望轨迹。
在可选的实施方式中,所述方法还包括:
获取所述双足机器人当前的运动状况信息;
根据所述运动状况信息以及所述质心位置规划轨迹,确定所述双足机器人的双足踝关节当前在行走过程中的期望力矩;
根据所述运动状况信息以及所述双足踝关节的期望力矩,确定所述双足踝关节当前的期望姿态角;
根据所述双足踝关节当前的期望姿态角计算得到所述双足机器人当前所在斜坡的目标坡度角。
在可选的实施方式中,所述根据所述运动状况信息以及所述质心位置规划轨迹,确定所述双足机器人的双足踝关节当前在行走过程中的期望力矩的步骤,包括:
根据所述运动状况信息包括的质心实际位置及质心实际速度,计算所述双足机器人当前对应的捕获点CP预估位置;
根据所述质心位置规划轨迹包括的质心规划位置及质心规划速度,计算所述双足机器人当前对应的CP规划位置;
计算所述CP规划位置与所述CP预估位置之间的CP位置差异;
根据所述运动状况信息包括的双足实际位置以及所述腿部摆动规划轨迹包括的零力矩点规划位置,计算所述双足机器人当前的双足期望支撑力;
针对所述双足机器人的每个足部,根据该足部的期望支撑力及所述CP位置差异进行踝关节力矩计算,得到与该足部对应的踝关节的期望力矩。
在可选的实施方式中,所述根据所述运动状况信息以及所述双足踝关节的期望力矩,确定所述双足踝关节当前的期望姿态角的步骤,包括:
针对所述双足机器人的每个足部,从所述运动状况信息提取与该足部对应的踝关节的实际力矩及实际角速度;
将与该足部对应的踝关节的期望力矩、实际力矩及实际角速度,代入到与该足部对应的踝关节姿态控制方程中进行方程求解,得到与该足部对应的踝关节的期望姿态角。
第二方面,本申请提供一种机器人行走控制装置,所述装置包括:
行走信息获取模块,用于获取双足机器人当前的平地行走规划轨迹,以及所述双足机器人当前所在斜坡的目标坡度角,其中所述平地行走规划轨迹包括所述双足机器人平地行走时的腿部摆动规划轨迹及质心位置规划轨迹;
腿部轨迹适配模块,用于根据所述目标坡度角对所述腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹;
质心轨迹补偿模块,用于根据所述目标坡度角对所述质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹;
驱动参数计算模块,用于基于机器人逆运动学算法计算同时与所述腿部摆动期望轨迹及所述质心位置期望轨迹匹配的期望驱动参数;
斜坡行走控制模块,用于按照所述期望驱动参数控制所述双足机器人进行运动,使所述双足机器人在对应斜坡上行走。
在可选的实施方式中,所述装置还包括:
运动信息获取模块,用于获取所述双足机器人当前的运动状况信息;
期望力矩确定模块,用于根据所述运动状况信息以及所述质心位置规划轨迹,确定所述双足机器人的双足踝关节当前在行走过程中的期望力矩;
期望姿态确定模块,用于根据所述运动状况信息以及所述双足踝关节的期望力矩,确定所述双足踝关节当前的期望姿态角;
斜坡角度计算模块,用于根据所述双足踝关节当前的期望姿态角计算得到所述双足机器人当前所在斜坡的目标坡度角。
第三方面,本申请提供一种机器人控制设备,包括处理器和存储器,所述存储器存储有能够被所述处理器执行的计算机程序,所述处理器可执行所述计算机程序,实现前述实施方式中任意一项所述的机器人行走控制方法。
第四方面,本申请提供一种存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时,实现前述实施方式中任意一项所述的机器人行走控制方法。
在此情况下,本申请实施例的有益效果包括以下内容:
本申请在获取到双足机器人当前的平地行走规划轨迹以及该双足机器人当前所在斜坡的目标坡度角后,会基于目标坡度角对平地行走规划轨迹中的腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹,并基于目标坡度角对平地行走规划轨迹中的质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹,而后基于机器人逆运动学算法计算同时与腿部摆动期望轨迹及质心位置期望轨迹匹配的期望驱动参数,接着采用期望驱动参数控制双足机器人进行运动,从而使双足机器人在平地行走过程中遇到斜坡地形的情况下能够平稳地行走在对应坡面上,防止双足机器人摔倒,提升双足机器人的行走稳定性。
为使本申请的上述目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合所附附图,作详细说明如下。
附图说明
为了更清楚地说明本申请实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本申请的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1为本申请实施例提供的机器人控制设备的组成示意图;
图2为本申请实施例提供的双足机器人的行走示意图;
图3为本申请实施例提供的机器人行走控制方法的流程示意图之一;
图4为图3中的步骤S220包括的子步骤的流程示意图;
图5为本申请实施例提供的平地行走与坡面行走的腿部摆动轨迹比较示意图;
图6为图3中的步骤S230包括的子步骤的流程示意图;
图7为本申请实施例提供的平地行走与坡面行走的质心位置轨迹比较示意图;
图8为本申请实施例提供的机器人行走控制方法的流程示意图之二;
图9为图8中的步骤S270包括的子步骤的流程示意图;
图10为图8中的步骤S280包括的子步骤的流程示意图;
图11为本申请实施例提供的机器人行走控制装置的组成示意图之一;
图12为本申请实施例提供的机器人行走控制装置的组成示意图之二。
图标:10-机器人控制设备;11-存储器;12-处理器;13-通信单元;100-机器人行走控制装置;110-行走信息获取模块;120-腿部轨迹适配模块;130-质心轨迹补偿模块;140-驱动参数计算模块;150-斜坡行走控制模块;160-运动信息获取模块;170-期望力矩确定模块;180-期望姿态确定模块;190-斜坡角度计算模块。
具体实施方式
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本申请实施例的组件可以以各种不同的配置来布置和设计。
因此,以下对在附图中提供的本申请的实施例的详细描述并非旨在限制要求保护的本申请的范围,而是仅仅表示本申请的选定实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。
在本申请的描述中,需要理解的是,术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,或者是该申请产品使用时惯常摆放的方位或位置关系,或者是本领域技术人员惯常理解的方位或位置关系,仅是为了便于描述本申请和简化描述,而不是指示或暗示所指的设备或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本申请的限制。
此外,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本申请中的具体含义。
下面结合附图,对本申请的一些实施方式作详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互结合。
请参照图1,图1是本申请实施例提供的机器人控制设备10的组成示意图。在本申请实施例中,所述机器人控制设备10用于对双足机器人的运行状态进行控制,使所述双足机器人能够按照预设的平地行走规划轨迹在平地上行走,并在所述双足机器人遇到斜坡地形的情况下也能控制该双足机器人平稳地行走在对应坡面上,防止双足机器人出现摔倒现象,从而提升双足机器人的行走稳定性。其中,所述机器人控制设备10可以与双足机器人远程通信连接,也可以与所述双足机器人集成在一起,用以实现对所述双足机器人的运动控制功能。
在本实施例中,所述机器人控制设备10可以包括存储器11、处理器12、通信单元13及机器人行走控制装置100。其中,所述存储器11、所述处理器12及所述通信单元13各个元件相互之间直接或间接地电性连接,以实现数据的传输或交互。例如,所述存储器11、所述处理器12及所述通信单元13这些元件相互之间可通过一条或多条通讯总线或信号线实现电性连接。
在本实施例中,所述存储器11可以是,但不限于,随机存取存储器(RandomAccessMemory,RAM),只读存储器(Read Only Memory,ROM),可编程只读存储器(ProgrammableRead-Only Memory,PROM),可擦除只读存储器(Erasable Programmable Read-OnlyMemory,EPROM),电可擦除只读存储器(Electric Erasable Programmable Read-OnlyMemory,EEPROM)等。其中,所述存储器11用于存储计算机程序,所述处理器12在接收到执行指令后,可相应地执行所述计算机程序。
在本实施例中,所述处理器12可以是一种具有信号的处理能力的集成电路芯片。所述处理器12可以是通用处理器,包括中央处理器(CentralProcessing Unit,CPU)、图形处理器(Graphics Processing Unit,GPU)及网络处理器(NetworkProcessor,NP)、数字信号处理器(DSP)、专用集成电路(ASIC)、现成可编程门阵列(FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件中的至少一种。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等,可以实现或者执行本申请实施例中的公开的各方法、步骤及逻辑框图。
在本实施例中,所述通信单元13用于通过网络建立所述机器人控制设备10与其他电子设备之间的通信连接,并通过所述网络收发数据,其中所述网络包括有线通信网络及无线通信网络。例如,所述机器人控制设备10可以通过所述通信单元13从行走规划设备处获取针对所述双足机器人的平地行走规划轨迹,并通过所述通信单元13向所述双足机器人发送运动控制指令,使所述双足机器人按照所述运动控制指令进行运动。
在本实施例中,所述机器人行走控制装置100包括至少一个能够以软件或固件的形式存储于所述存储器11中或者在所述机器人控制设备10的操作系统中的软件功能模块。所述处理器12可用于执行所述存储器11存储的可执行模块,例如所述机器人行走控制装置100所包括的软件功能模块及计算机程序等。所述机器人控制设备10可通过所述机器人行走控制装置100对双足机器人的平地行走规划轨迹进行扩展,使双足机器人在平地行走过程中遇到斜坡地形的情况下能够基于平地行走规划轨迹实现坡面平稳行走功能,避免双足机器人在坡面行走过程中出现摔倒现象,从而提升了双足机器人的行走稳定性。
可以理解的是,图1所示的框图仅为所述机器人控制设备10的一种组成示意图,所述机器人控制设备10还可包括比图1中所示更多或者更少的组件,或者具有与图1所示不同的配置。图1中所示的各组件可以采用硬件、软件或其组合实现。
而对双足机器人来说,可以参照图2所示的双足机器人的行走示意图对机器人行走运动进行描述。在本申请实施例中,所述双足机器人无论是行走在平地上还是行走在坡度为θ的坡面上,都可存在两种支撑状态(即双腿支撑状态和单腿支撑状态)。当所述双足机器人处于双腿支撑状态时,所述双足机器人的双腿都可作为支撑腿用以支撑所述双足机器人保持站立状态;当所述双足机器人处于单腿支撑状态时,所述双足机器人的一条腿将作为支撑腿用以支撑所述双足机器人保持站立状态,所述双足机器人的另一条腿将作为需要进行移动轨迹变化的摆动腿。其中,摆动腿的移动轨迹变化操作包括摆动腿抬腿操作以及摆动腿落脚操作。
其中,可通过将与所述双足机器人的足底接触的水平地面作为世界坐标系的原点,建立笛卡尔右手坐标系,使X轴的正方向代表双足机器人的前进方向,使Y轴的正方向代表双足机器人的右侧朝向,使Z轴的正方向垂直地面向上。
由此,可通过该笛卡尔右手坐标系对该双足机器人中各部件在整个世界坐标系中的位置分布状况进行表示,以便于所述机器人控制设备10基于该笛卡尔右手坐标系控制双足机器人将自身部件分别移动到期望位置。
在本申请中,为确保所述机器人控制设备10能够对平地行走规划轨迹进行扩展,使双足机器人在平地行走过程中遇到斜坡地形时基于平地行走规划轨迹实现坡面平稳行走功能,以提升双足机器人的行走稳定性,本申请实施例通过提供一种机器人行走控制方法实现前述目的。下面对本申请提供的机器人行走控制方法进行详细描述。
请参照图3,图3是本申请实施例提供的机器人行走控制方法的流程示意图之一。在本申请实施例中,图3所示的机器人行走控制方法可以包括步骤S210~步骤S250。
步骤S210,获取双足机器人当前的平地行走规划轨迹,以及双足机器人当前所在斜坡的目标坡度角,其中平地行走规划轨迹包括双足机器人平地行走时的腿部摆动规划轨迹及质心位置规划轨迹。
在本实施例中,所述平地行走规划轨迹用于表示针对所述双足机器人预先规划出的实现平地行走功能的机器人运动轨迹,至少包括该双足机器人在平地行走过程中的腿部摆动规划轨迹及质心位置规划轨迹。其中,可通过倒立摆模型对双足机器人进行抽象化处理,以将双足机器人的所有质量都集中到质心处,并将双足机器人的两条腿视作两个无质量的伸缩摆杆,从而得以倒立摆模型为基础利用倒立摆模型的动力学方程构建出对应的腿部摆动规划轨迹及质心位置规划轨迹。
当所述双足机器人在平地行走过程中遇到斜坡地形时,可通过与所述机器人控制设备10通信的其他视觉设备(例如,摄像头)通过视觉观测方式确定该双足机器人当前所在斜坡的目标坡度角,也可由所述机器人控制设备10根据双足机器人当前的运动状况自适应地预估出该双足机器人当前所在斜坡的目标坡度角。
步骤S220,根据目标坡度角对腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹。
在本实施例中,当所述机器人控制设备10在获取到双足机器人当前在平地上应该展现出的腿部摆动规划轨迹,以及该双足机器人当前实际所在斜坡的目标坡度角后,会采用该目标坡度角对当前对应的腿部摆动规划轨迹进行参数修正,使修正得到的腿部摆动期望轨迹能够让双足机器人当前的摆动腿能够正常且平稳地落在对应斜坡的坡面上,避免双足机器人的摆动腿出现提前着地问题,提升双足机器人在坡面行走过程中的腿部摆动平稳性。
可选地,请参照图4,图4是图3中的步骤S220包括的子步骤的流程示意图。在本实施例中,所述步骤S220可以包括子步骤S221~子步骤S223,以确保最终输出的腿部摆动期望轨迹与双足机器人当前实际所在斜坡匹配,确保双足机器人按照腿部摆动期望轨迹在对应坡面行走时具有良好的腿部摆动平稳性。
子步骤S221,根据目标坡度角及腿部摆动规划轨迹包括的规划步长,计算双足机器人当前在对应斜坡上的摆动腿抬腿位置与摆动腿落点位置之间的期望迈步距离及期望落足高度变化量。
在本实施例中,请参照图5所示的平地行走与坡面行走的腿部摆动轨迹比较示意图,平地行走时对应的腿部摆动规划轨迹与坡面行走时对应的腿部摆动期望轨迹可通过捕获点(Capture Point,CP)算法构建形成。其中,所述双足机器人的摆动腿移动轨迹变化操作(即腿部摆动轨迹)可被分解为抬腿阶段的摆动腿抬腿操作以及落脚阶段的摆动腿落脚操作,其中抬腿阶段指的是对应摆动腿足部从摆动腿抬腿位置(例如,图5中的A点或A'点)开始摆动到最高摆动位置(例如,图5中的B点或B'点)的整个运动过程,而落脚阶段则指的是对应摆动腿足部从最高摆动位置摆动到摆动腿落点位置(例如,图5中的C点或C'点)的整个运动过程。
对于平地行走时对应的腿部摆动规划轨迹(图5中的上方视图所示)来说,摆动腿足部的摆动腿抬腿位置与摆动腿落点位置在Z轴方向上的高度是一致的,此时该腿部摆动规划轨迹的规划抬腿高度即为对应最高摆动位置与摆动腿落点位置在Z轴方向上的高度大小,该腿部摆动规划轨迹的规划步长即为摆动腿抬腿位置与摆动腿落点位置在X轴方向上的间距大小。
而对坡面行走时对应的腿部摆动期望轨迹(图5中的下方视图所示)来说,其相对于腿部摆动规划轨迹需要与坡面地形相适配,否则如果仍然使用腿部摆动规划轨迹来维持摆动腿抬腿位置与摆动腿落点位置的高度一致的话,双足机器人在落脚阶段就会出现严重的提前着地问题,影响机器人的腿部摆动稳定性。
由此,需要将斜坡所引起的落足高度变化量考虑到所述腿部摆动期望轨迹中,此时所述双足机器人当前在对应斜坡上的摆动腿抬腿位置(A'点)与摆动腿落点位置(C'点)之间的期望迈步距离即可由所述腿部摆动规划轨迹包括的规划步长除以所述目标坡度角的余弦值得到,所述双足机器人当前在对应斜坡上的期望落足高度变化量即可由所述腿部摆动规划轨迹包括的规划步长乘以所述目标坡度角的正切值得到。
子步骤S222,采用期望落足高度变化量对腿部摆动规划轨迹包括的规划抬腿高度进行补偿,得到双足机器人当前在对应斜坡上的期望抬腿高度。
在本实施例中,对坡面行走时对应的腿部摆动期望轨迹来说,其对应的期望抬腿高度即为对应坡面上的摆动腿抬腿位置(A'点)与最高摆动位置(B'点)在Z轴方向上的高度大小。可通过将腿部摆动规划轨迹包括的规划抬腿高度与计算出的期望落足高度变化量进行加法运算所得到的高度数值,作为该双足机器人当前在对应斜坡上的期望抬腿高度,从而将斜坡所引起的落足高度变化量考虑到所述腿部摆动期望轨迹的规划过程中。
子步骤S223,根据期望迈步距离及期望抬腿高度规划形成对应的腿部摆动期望轨迹。
在本实施例中,当确定出所述双足机器人当前在对应斜坡上的期望迈步距离以及期望抬腿高度后,可基于CP算法所对应的三次样条曲线轨迹规划方法,针对所述双足机器人当前所在斜坡重新规划出匹配的用以提高坡面行走过程中的腿部摆动平稳性的腿部摆动期望轨迹。
由此,本申请可通过执行上述子步骤S221~子步骤S223,确保最终输出的腿部摆动期望轨迹与双足机器人当前实际所在斜坡匹配,确保双足机器人按照腿部摆动期望轨迹在对应坡面行走时具有良好的腿部摆动平稳性。
步骤S230,根据目标坡度角对质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹。
在本实施例中,当所述机器人控制设备10在获取到双足机器人当前在平地上应该展现出的质心位置规划轨迹,以及该双足机器人当前实际所在斜坡的目标坡度角后,会采用该目标坡度角对当前对应的质心位置规划轨迹进行参数补偿,使补偿得到的质心位置期望轨迹能够让双足机器人在坡面行走过程中的姿态维持平衡,避免双足机器人出现后侧倾倒问题,提升双足机器人在坡面行走过程中的平衡稳定性。
可选地,请参照图6,图6是图3中的步骤S230包括的子步骤的流程示意图。在本实施例中,所述步骤S230可以包括子步骤S231~子步骤S232,以确保最终输出的质心位置期望轨迹与双足机器人当前实际所在斜坡匹配,确保双足机器人按照质心位置期望轨迹在对应坡面行走时的机器人姿态具有良好的平衡稳定性。
子步骤S231,根据双足机器人的从踝关节到足底之间的肢体高度以及目标坡度角,计算双足机器人当前的质心前移补偿量。
在本实施例中,请参照图7所示的平地行走与坡面行走的质心位置轨迹比较示意图,对于平地行走时对应的质心位置规划轨迹来说,为保证双足机器人在平地上站立时处于平衡状态,通常需要质心M在Z轴方向上的投影点M0维持在对应支撑腿的踝关节正下方,即支撑腿脚掌中心位置(如图7中的上方视图所示)。
而对于坡面行走时对应的质心位置期望轨迹来说,其相对于质心位置规划轨迹需要与坡面地形相适配,否则如果仍然使用质心位置规划轨迹来维持质心投影点处于对应支撑腿的踝关节正下方(如图7中下方视图的质心M在Z轴方向上的投影点M1)的话,双足机器人的中心位置将会靠近支撑腿的脚掌后侧,并非支撑腿的脚掌中心位置,使双足机器人容易出现后侧倾倒问题,影响机器人的行走姿态平衡稳定性。
由此,需要将斜坡引起的质心位置变化量考虑到所述质心位置期望轨迹中,来使所述质心位置期望轨迹所对应的质心M在Z轴方向上的投影点M2控制在对应支撑腿脚掌中心位置(如图7中的下方视图所示),此时所述双足机器人当前在前进方向上所需的质心位置变化量(即质心前移补偿量)即可由所述双足机器人的从踝关节到足底之间的肢体高度乘以所述目标坡度角的正弦值得到,所述双足机器人当前在Z轴方向上所需的质心位置变化量也需与落足高度变化量保持一致,以保证机器人质心高度随坡面变化逐步升高或降低,即所述双足机器人当前在Z轴方向上所需的质心位置变化量将与上述期望落足高度变化量相等。
子步骤S232,采用质心前移补偿量对质心位置规划轨迹包括的质心前移规划位置进行补偿,并采用期望落足高度变化量对质心位置规划轨迹包括的质心高度规划位置进行补偿,得到对应的质心位置期望轨迹。
在本实施例中,所述质心前移规划位置用于表示所述质心位置规划轨迹中质心规划位置在机器人前进方向(X轴方向)上的规划位置分量,所述质心高度规划位置用于表示所述质心位置规划轨迹中质心规划位置在Z轴方向上的规划位置分量,而所述质心规划位置在Y轴方向上的规划位置分量即可表示为质心侧移规划位置。此时,可通过将上述计算出的质心前移补偿量叠加到所述质心位置规划轨迹包括的质心前移规划位置上,并将上述计算出的期望落足高度变化量叠加到所述质心位置规划轨迹包括的质心高度规划位置上,进而相应地求得所述双足机器人当前在对应斜坡上的质心前移期望位置及质心高度期望位置,而后基于常规轨迹规划手段确定出当前匹配的质心位置期望轨迹。
由此,本申请可通过执行上述子步骤S231及子步骤S232,确保最终输出的质心位置期望轨迹与双足机器人当前实际所在斜坡匹配,确保双足机器人按照质心位置期望轨迹在对应坡面行走时的机器人姿态具有良好的平衡稳定性。
请再次参照图3,步骤S240,基于机器人逆运动学算法计算同时与腿部摆动期望轨迹及质心位置期望轨迹匹配的期望驱动参数。
在本实施例中,当所述机器人控制设备10确定出所述双足机器人当前在斜坡上行走所需的腿部摆动期望轨迹及质心位置期望轨迹后,可基于机器人逆运动学算法求解出同时实现所述腿部摆动期望轨迹及所述质心位置期望轨迹所需的针对所述双足机器人的期望驱动参数。其中,所述期望驱动参数可采用所述双足机器人各关节的期望角加速度和所述双足机器人双足的期望足底力参数组成,所述期望足底力参数可以包括对应足部的期望足底力矢量在笛卡尔坐标系下的X轴、Y轴及Z轴方向上的分量,和对应足部的期望足底力矩矢量在笛卡尔坐标系下的X轴、Y轴及Z轴方向上的分量。
子步骤S250,按照期望驱动参数控制双足机器人进行运动,使双足机器人在对应斜坡上行走。
在本实施例中,当所述机器人控制设备10确定出与所述双足机器人当前所在斜坡对应的期望驱动参数后,可通过按照所述期望驱动参数对所述双足机器人的各真实关节的运行状况进行控制,以确保所述双足机器人能够在对应斜坡上平稳地行走。
由此,本申请可通过执行上述步骤S210~步骤S250,对平地行走规划轨迹进行扩展,使双足机器人在平地行走过程中遇到斜坡地形时基于平地行走规划轨迹实现坡面平稳行走功能,以防止双足机器人摔倒,提升双足机器人的行走稳定性。
可选地,在本申请中,为确保针对所述双足机器人计算出的腿部摆动期望轨迹及质心位置期望轨迹均是与双足机器人当前所在斜坡的真实坡度匹配,本申请实施例通过提供一种利用双足机器人脚掌自适应地预估出双足机器人当前所在斜坡的坡度的方法来提升斜坡坡度感知精准度,进一步提升双足机器人的坡面行走稳定性。
请参照图8,图8是本申请实施例提供的机器人行走控制方法的流程示意图之二。在本申请实施例中,图8所示的机器人行走控制方法可以包括步骤S260~步骤S290,以确保最终预估出的斜坡坡度具有更高的准确性,提升斜坡坡度感知精准度,进一步提升双足机器人的坡面行走稳定性。
步骤S260,获取双足机器人当前的运动状况信息。
在本实施例中,所述双足机器人的运动状况信息可由安装在所述双足机器人不同部位的传感器进行实时感知,所述运动状况信息可以是,但不限于,质心实际位置、质心实际速度、双足实际位置、双足实际力矩及双足实际角速度等。
步骤S270,根据运动状况信息以及质心位置规划轨迹,确定双足机器人的双足踝关节当前在行走过程中的期望力矩。
在本实施例中,当所述机器人控制设备10获取到所述双足机器人当前在斜坡上的运动状况信息后,会根据CP算法在倒立摆模型中的算法表达式确定出所述质心位置规划轨迹与所述运动状况信息在CP点位置方面上存在的CP位置差异状况,而后基于双足机器人在当前时刻表现出的双足支撑力,确定出该双足机器人的双足踝关节要克服所述CP位置差异状况所需的期望力矩。
可选地,请参照图9,图9是图8中的步骤S270包括的子步骤的流程示意图。在本实施例中,所述步骤S270可以包括子步骤S271~275。
子步骤S271,根据运动状况信息包括的质心实际位置及质心实际速度,计算双足机器人当前对应的CP预估位置。
在本实施例中,CP算法在倒立摆模型中的算法表达式可表示为其中,ξ1用于表示双足机器人在X轴与Z轴所在平面上的CP位置,x用于表示倒立摆质心在X轴上的位置分量,用于表示倒立摆质心在X轴上的速度分量,ξ2用于表示双足机器人在Y轴与Z轴所在平面上的CP位置,y用于表示倒立摆质心在Y轴上的位置分量,用于表示倒立摆质心在Y轴上的速度分量,ω用于表示所述双足机器人的腿部摆动频率,其值等于重力加速度与倒立摆质心在Z轴上的位置分量之间的比值的平方根。
由此,所述机器人控制设备10可根据所述运动状况信息包括的质心实际位置及质心实际速度各自在X轴上的分量,利用公式计算出所述双足机器人当前对应的CP预估位置在X轴上的位置分量,并根据所述运动状况信息包括的质心实际位置及质心实际速度各自在Y轴上的分量,利用公式计算出所述双足机器人当前对应的CP预估位置在Y轴上的位置分量。
子步骤S272,根据质心位置动规划轨迹包括的质心规划位置及质心规划速度,计算双足机器人当前对应的CP规划位置。
在本实施例中,所述机器人控制设备10可根据所述质心位置规划轨迹包括的质心规划位置及质心规划速度各自在X轴上的分量,利用公式计算出所述双足机器人当前对应的CP规划位置在X轴上的位置分量,并根据所述质心规划位置及所述质心规划速度各自在Y轴上的分量,利用公式计算出所述双足机器人当前对应的CP规划位置在Y轴上的位置分量。
子步骤S273,计算CP规划位置与CP预估位置之间的CP位置差异。
在本实施例中,所述机器人控制设备10可将所述CP规划位置在X轴上的位置分量与所述CP预估位置在X轴上的位置分量进行减法运算,得到所述CP位置差异在X轴上的差异分量,并将所述CP规划位置在Y轴上的位置分量与所述CP预估位置在Y轴上的位置分量进行减法运算,得到所述CP位置差异在Y轴上的差异分量。
子步骤S274,根据运动状况信息包括的双足实际位置以及腿部摆动规划轨迹包括的零力矩点规划位置,计算双足机器人当前的双足期望支撑力。
在本实施例中,所述腿部摆动规划轨迹在预先规划时会针对双足机器人的零力矩点位置进行规划,即得到该腿部摆动规划轨迹包括的零力矩点规划位置。此时,所述机器人控制设备10可采用如下式子计算出所述双足机器人当前的双足期望支撑力:
其中,fld用于表示双足机器人左足的期望支撑力,frd用于表示双足机器人右足的期望支撑力,pyplan用于表示零力矩点规划位置在Y轴上的位置分量,plf用于表示双足机器人左足实际位置在Y轴上的位置分量,prf用于表示双足机器人右足实际位置在Y轴上的位置分量,M用于表示双足机器人质量,0<=Kf<=1。
子步骤S275,针对双足机器人的每个足部,根据该足部的期望支撑力及CP位置差异进行踝关节力矩计算,得到与该足部对应的踝关节的期望力矩。
在本实施例中,针对所述双足机器人的左足足部或者右足足部,可通过将该足部所对应的踝关节控制器参数及期望支撑力,与所述CP位置差异在X轴上的差异分量进行乘法运算,得到与该足部对应的踝关节的期望力矩在X轴上的力矩分量,并通过将该足部所对应的踝关节控制器参数及期望支撑力,与所述CP位置差异在Y轴上的差异分量进行乘法运算,得到与该足部对应的踝关节的期望力矩在Y轴上的力矩分量。由此,可相应地确定出该双足机器人的双足踝关节要克服摆动CP位置差异状况所需的期望力矩。
步骤S280,根据运动状况信息以及双足踝关节的期望力矩,确定双足踝关节当前的期望姿态角。
在本实施例中,当所述机器人控制设备10获取到双足机器人的双足踝关节要克服CP位置差异状况所需的期望力矩后,可结合该双足机器人当前在斜坡上表现出的双足踝关节实际状态,确定出该双足机器人要克服斜坡的坡度所需表现出的双足踝关节当前的期望姿态角。
可选地,请参照图10,图10是图8中的步骤S280包括的子步骤的流程示意图。在本实施例中,所述步骤S280可以包括子步骤S281及子步骤S282。
子步骤S281,针对双足机器人的每个足部,从运动状况信息提取与该足部对应的踝关节的实际力矩及实际角速度。
子步骤S282,将与该足部对应的踝关节的期望力矩、实际力矩及实际角速度,代入到与该足部对应的踝关节姿态控制方程中进行方程求解,得到与该足部对应的踝关节的期望姿态角。
其中,所述踝关节姿态控制方程可以采用PD控制手段构建形成,也可以采用PID控制手段构建形成,还可以采用PI控制手段构建形成。所述机器人控制设备10可通过将同一足部所对应的踝关节的期望力矩、实际力矩及实际角速度各自在X轴上的分量代入到对应踝关节姿态控制方程中进行方程求解,得到该足部所对应的踝关节的期望姿态角在X轴上的姿态角分量,并通过将同一足部所对应的踝关节的期望力矩、实际力矩及实际角速度各自在Y轴上的分量代入到对应踝关节姿态控制方程中进行方程求解,得到该足部所对应的踝关节的期望姿态角在Y轴上的姿态角分量。在本实施例的一种实施方式中,所述踝关节姿态控制方程可采用如下式子进行表示:
其中,R用于表示对应足部的踝关节的期望姿态角,Td用于表示对应足部的踝关节的期望力矩,Tm用于表示对应足部的踝关节的实际力矩,用于表示对应足部的踝关节的角速度,KP用于表示对应足部的踝关节的控制器阻尼项参数,Ks用于表示对应足部的踝关节的控制器刚度项参数。由此,可相应地确定出该双足机器人要克服斜坡的坡度所需表现出的双足踝关节当前的期望姿态角。
步骤S290,根据双足踝关节当前的期望姿态角计算得到双足机器人当前所在斜坡的目标坡度角。
在本实施例中,当所述机器人控制设备10计算出所述双足机器人在当前所在斜坡上所对应的双足踝关节的期望姿态角后,可通过选取双足踝关节的期望姿态角各自在Y轴上的姿态角分量进行均值计算,而后将计算出的角度数据作为所述双足机器人当前所在斜坡的目标坡度角,从而确保预估出的斜坡坡度与所述双足机器人关联性更强,确保预估出的斜坡坡度具有更高的准确性,以提升斜坡坡度感知精准度,并进一步提升双足机器人的坡面行走稳定性。
由此,本申请可通过执行上述步骤S260~步骤S290,利用双足机器人脚掌自适应地预估出双足机器人当前所在斜坡坡度,确保预估出的斜坡坡度与所述双足机器人关联性更强,确保预估出的斜坡坡度具有更高的准确性,以提升斜坡坡度感知精准度,并进一步提升双足机器人的坡面行走稳定性。
在本申请中,为确保所述机器人控制设备10能够通过所述机器人行走控制装置100执行上述机器人行走控制方法,本申请通过对所述机器人行走控制装置100进行功能模块划分的方式实现前述功能。下面对本申请提供的机器人行走控制装置100的具体组成进行相应描述。
请参照图11,图11是申请实施例提供的机器人行走控制装置100的组成示意图之一。在本申请实施例中,所述机器人行走控制装置100可以包括行走信息获取模块110、腿部轨迹适配模块120、质心轨迹补偿模块130、驱动参数计算模块140及斜坡行走控制模块150。
行走信息获取模块110,用于获取双足机器人当前的平地行走规划轨迹,以及双足机器人当前所在斜坡的目标坡度角,其中平地行走规划轨迹包括双足机器人平地行走时的腿部摆动规划轨迹及质心位置规划轨迹。
腿部轨迹适配模块120,用于根据目标坡度角对腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹。
质心轨迹补偿模块130,用于根据目标坡度角对质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹。
驱动参数计算模块140,用于基于机器人逆运动学算法计算同时与腿部摆动期望轨迹及质心位置期望轨迹匹配的期望驱动参数。
斜坡行走控制模块150,用于按照期望驱动参数控制双足机器人进行运动,使双足机器人在对应斜坡上行走。
可选地,请参照图12,图12是本申请实施例提供的机器人行走控制装置100的组成示意图之二。在本申请实施例中,所述机器人行走控制装置100还可以包括运动信息获取模块160、期望力矩确定模块170、期望姿态确定模块180及斜坡角度计算模块190。
运动信息获取模块160,用于获取双足机器人当前的运动状况信息。
期望力矩确定模块170,用于根据运动状况信息以及质心位置规划轨迹,确定双足机器人的双足踝关节当前在行走过程中的期望力矩。
期望姿态确定模块180,用于根据运动状况信息以及双足踝关节的期望力矩,确定双足踝关节当前的期望姿态角。
斜坡角度计算模块190,用于根据双足踝关节当前的期望姿态角计算得到双足机器人当前所在斜坡的目标坡度角。
需要说明的是,本申请实施例所提供的机器人行走控制装置100,其基本原理及产生的技术效果与前述的机器人行走控制方法相同。为简要描述,本实施例部分未提及之处,可参考上述的针对机器人行走控制方法的描述内容。
在本申请所提供的实施例中,应该理解到,所揭露的装置和方法,也可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,附图中的流程图和框图显示了根据本申请的实施例的装置、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段或代码的一部分,所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在有些作为替换的实现方式中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个连续的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合,可以用执行规定的功能或动作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令的组合来实现。
另外,在本申请各个实施例中的各功能模块可以集成在一起形成一个独立的部分,也可以是各个模块单独存在,也可以两个或两个以上模块集成形成一个独立的部分。所述功能如果以软件功能模块的形式实现并作为独立的产品销售或使用时,可以存储在一个存储介质中。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random AccessMemory)、磁碟或者光盘等各种可以存储程序代码的介质。
综上所述,在本申请提供的机器人行走控制方法、装置、机器人控制设备及存储介质中,本申请在获取到双足机器人当前的平地行走规划轨迹以及该双足机器人当前所在斜坡的目标坡度角后,会基于目标坡度角对平地行走规划轨迹中的腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹,并基于目标坡度角对平地行走规划轨迹中的质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹,而后基于机器人逆运动学算法计算同时与腿部摆动期望轨迹及质心位置期望轨迹匹配的期望驱动参数,接着采用期望驱动参数控制双足机器人进行运动,从而使双足机器人在平地行走过程中遇到斜坡地形的情况下能够平稳地行走在对应坡面上,防止双足机器人摔倒,提升双足机器人的行走稳定性。
以上所述,仅为本申请的各种实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应当以权利要求的保护范围为准。
Claims (10)
1.一种机器人行走控制方法,其特征在于,所述方法包括:
获取双足机器人当前的平地行走规划轨迹,以及所述双足机器人当前所在斜坡的目标坡度角,其中所述平地行走规划轨迹包括所述双足机器人平地行走时的腿部摆动规划轨迹及质心位置规划轨迹;
根据所述目标坡度角对所述腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹;
根据所述目标坡度角对所述质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹;
基于机器人逆运动学算法计算同时与所述腿部摆动期望轨迹及所述质心位置期望轨迹匹配的期望驱动参数;
按照所述期望驱动参数控制所述双足机器人进行运动,使所述双足机器人在对应斜坡上行走。
2.根据权利要求1所述的方法,其特征在于,所述根据所述目标坡度角对所述腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹的步骤,包括:
根据所述目标坡度角及所述腿部摆动规划轨迹包括的规划步长,计算所述双足机器人当前在对应斜坡上的摆动腿抬腿位置与摆动腿落点位置之间的期望迈步距离及期望落足高度变化量;
采用所述期望落足高度变化量对所述腿部摆动规划轨迹包括的规划抬腿高度进行补偿,得到所述双足机器人当前在对应斜坡上的期望抬腿高度;
根据所述期望迈步距离及所述期望抬腿高度规划形成对应的腿部摆动期望轨迹。
3.根据权利要求2所述的方法,其特征在于,所述根据所述目标坡度角对所述质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹的步骤,包括:
根据所述双足机器人的从踝关节到足底之间的肢体高度以及所述目标坡度角,计算所述双足机器人当前的质心前移补偿量;
采用所述质心前移补偿量对所述质心位置规划轨迹包括的质心前移规划位置进行补偿,并采用所述期望落足高度变化量对所述质心位置规划轨迹包括的质心高度规划位置进行补偿,得到对应的质心位置期望轨迹。
4.根据权利要求1-3中任意一项所述的方法,其特征在于,所述方法还包括:
获取所述双足机器人当前的运动状况信息;
根据所述运动状况信息以及所述质心位置规划轨迹,确定所述双足机器人的双足踝关节当前在行走过程中的期望力矩;
根据所述运动状况信息以及所述双足踝关节的期望力矩,确定所述双足踝关节当前的期望姿态角;
根据所述双足踝关节当前的期望姿态角计算得到所述双足机器人当前所在斜坡的目标坡度角。
5.根据权利要求4所述的方法,其特征在于,所述根据所述运动状况信息以及所述质心位置规划轨迹,确定所述双足机器人的双足踝关节当前在行走过程中的期望力矩的步骤,包括:
根据所述运动状况信息包括的质心实际位置及质心实际速度,计算所述双足机器人当前对应的捕获点CP预估位置;
根据所述质心位置规划轨迹包括的质心规划位置及质心规划速度,计算所述双足机器人当前对应的CP规划位置;
计算所述CP规划位置与所述CP预估位置之间的CP位置差异;
根据所述运动状况信息包括的双足实际位置以及所述腿部摆动规划轨迹包括的零力矩点规划位置,计算所述双足机器人当前的双足期望支撑力;
针对所述双足机器人的每个足部,根据该足部的期望支撑力及所述CP位置差异进行踝关节力矩计算,得到与该足部对应的踝关节的期望力矩。
6.根据权利要求4所述的方法,其特征在于,所述根据所述运动状况信息以及所述双足踝关节的期望力矩,确定所述双足踝关节当前的期望姿态角的步骤,包括:
针对所述双足机器人的每个足部,从所述运动状况信息提取与该足部对应的踝关节的实际力矩及实际角速度;
将与该足部对应的踝关节的期望力矩、实际力矩及实际角速度,代入到与该足部对应的踝关节姿态控制方程中进行方程求解,得到与该足部对应的踝关节的期望姿态角。
7.一种机器人行走控制装置,其特征在于,所述装置包括:
行走信息获取模块,用于获取双足机器人当前的平地行走规划轨迹,以及所述双足机器人当前所在斜坡的目标坡度角,其中所述平地行走规划轨迹包括所述双足机器人平地行走时的腿部摆动规划轨迹及质心位置规划轨迹;
腿部轨迹适配模块,用于根据所述目标坡度角对所述腿部摆动规划轨迹进行适配调整,得到对应的腿部摆动期望轨迹;
质心轨迹补偿模块,用于根据所述目标坡度角对所述质心位置规划轨迹进行参数补偿,得到对应的质心位置期望轨迹;
驱动参数计算模块,用于基于机器人逆运动学算法计算同时与所述腿部摆动期望轨迹及所述质心位置期望轨迹匹配的期望驱动参数;
斜坡行走控制模块,用于按照所述期望驱动参数控制所述双足机器人进行运动,使所述双足机器人在对应斜坡上行走。
8.根据权利要求7所述的装置,其特征在于,所述装置还包括:
运动信息获取模块,用于获取所述双足机器人当前的运动状况信息;
期望力矩确定模块,用于根据所述运动状况信息以及所述质心位置规划轨迹,确定所述双足机器人的双足踝关节当前在行走过程中的期望力矩;
期望姿态确定模块,用于根据所述运动状况信息以及所述双足踝关节的期望力矩,确定所述双足踝关节当前的期望姿态角;
斜坡角度计算模块,用于根据所述双足踝关节当前的期望姿态角计算得到所述双足机器人当前所在斜坡的目标坡度角。
9.一种机器人控制设备,其特征在于,包括处理器和存储器,所述存储器存储有能够被所述处理器执行的计算机程序,所述处理器可执行所述计算机程序,实现权利要求1-6中任意一项所述的机器人行走控制方法。
10.一种存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时,实现权利要求1-6中任意一项所述的机器人行走控制方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110739449.XA CN113359800A (zh) | 2021-06-30 | 2021-06-30 | 机器人行走控制方法、装置、机器人控制设备及存储介质 |
PCT/CN2021/131191 WO2023273107A1 (zh) | 2021-06-30 | 2021-11-17 | 机器人行走控制方法、装置、机器人控制设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110739449.XA CN113359800A (zh) | 2021-06-30 | 2021-06-30 | 机器人行走控制方法、装置、机器人控制设备及存储介质 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113359800A true CN113359800A (zh) | 2021-09-07 |
Family
ID=77537578
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110739449.XA Pending CN113359800A (zh) | 2021-06-30 | 2021-06-30 | 机器人行走控制方法、装置、机器人控制设备及存储介质 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN113359800A (zh) |
WO (1) | WO2023273107A1 (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113064433A (zh) * | 2021-03-22 | 2021-07-02 | 深圳市优必选科技股份有限公司 | 机器人迈步控制方法、装置、机器人控制设备及存储介质 |
CN114115280A (zh) * | 2021-11-29 | 2022-03-01 | 深圳市优必选科技股份有限公司 | 四足奔跑步态规划方法、装置及机器人控制设备 |
CN114115295A (zh) * | 2021-12-28 | 2022-03-01 | 深圳市优必选科技股份有限公司 | 机器人运动规划方法及装置、机器人控制设备和存储介质 |
CN114237212A (zh) * | 2021-10-15 | 2022-03-25 | Oppo广东移动通信有限公司 | 足式机器人移动方法、装置、存储介质及电子设备 |
CN114253260A (zh) * | 2021-12-08 | 2022-03-29 | 深圳市优必选科技股份有限公司 | 机器人步态规划方法及装置、运动规划设备和存储介质 |
CN114489104A (zh) * | 2022-01-21 | 2022-05-13 | 深圳市优必选科技股份有限公司 | 机器人迈步控制方法及装置、机器人控制设备和存储介质 |
CN115533924A (zh) * | 2022-12-01 | 2022-12-30 | 北京航空航天大学杭州创新研究院 | 协同运动控制方法及装置、机器人控制设备和存储介质 |
WO2023273107A1 (zh) * | 2021-06-30 | 2023-01-05 | 深圳市优必选科技股份有限公司 | 机器人行走控制方法、装置、机器人控制设备及存储介质 |
CN116149204A (zh) * | 2023-04-19 | 2023-05-23 | 五八智能科技(杭州)有限公司 | 一种双足机器人的动力学建模与控制方法 |
WO2024021744A1 (zh) * | 2022-07-25 | 2024-02-01 | 腾讯科技(深圳)有限公司 | 一种控制足式机器人的方法、装置、电子设备、计算机可读存储介质、计算机程序产品及足式机器人 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001198865A (ja) * | 2000-01-20 | 2001-07-24 | Toshiba Corp | 2足歩行ロボット装置およびその運用方法 |
WO2004051414A2 (en) * | 2002-11-27 | 2004-06-17 | Edc Biosystems, Inc. | Wave guide with isolated coupling interface |
US20060173578A1 (en) * | 2003-06-27 | 2006-08-03 | Honda Motor Co., Ltd. | Controller of legged mobile robot |
US20060197485A1 (en) * | 2003-04-17 | 2006-09-07 | Honda Motor Co., Ltd. | Method of assuming acting point of floor reaction force to biped walking mobile body and method of assuming joint moment of biped walking mobile body |
US20090281661A1 (en) * | 2008-04-24 | 2009-11-12 | Evolution Robotics | Application of localization, positioning & navigation systems for robotic enabled mobile products |
US20110196532A1 (en) * | 2007-12-17 | 2011-08-11 | Korea Institute Of Science And Technology | Apparatus and method for balancing and damping control in whole body coordination framework for biped humanoid robot |
EP2384863A2 (en) * | 2010-01-21 | 2011-11-09 | Institutul de Mecanica Solidelor al Academiei Romane | Method and device for dynamic control of a walking robot |
US20120245734A1 (en) * | 2011-03-21 | 2012-09-27 | Seungkook Yun | Humanoid robot push recovery on level and non-level ground |
CN103101060A (zh) * | 2011-11-11 | 2013-05-15 | 鸿富锦精密工业(深圳)有限公司 | 机器人工具中心点的传感校正方法 |
CN104331081A (zh) * | 2014-10-10 | 2015-02-04 | 北京理工大学 | 一种双足机器人斜面行走的步态规划方法 |
CN111880544A (zh) * | 2020-08-07 | 2020-11-03 | 深圳市优必选科技股份有限公司 | 仿人机器人步态规划方法、装置和仿人机器人 |
CN113021299A (zh) * | 2021-04-13 | 2021-06-25 | 山东大学 | 一种双腿轮复合机器人全方位运动控制方法 |
CN113050616A (zh) * | 2019-12-27 | 2021-06-29 | 深圳市优必选科技股份有限公司 | 一种双足机器人行走的控制方法及双足机器人 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008068339A (ja) * | 2006-09-12 | 2008-03-27 | Atsuo Takanishi | 歩行パターン作成装置、2足歩行ロボット装置、歩行パターン作成方法、2足歩行ロボット装置の制御方法、プログラムおよび記録媒体 |
CN101847009B (zh) * | 2010-05-28 | 2011-12-14 | 广东工业大学 | 两足机器人步态能效优化方法 |
CN105511465B (zh) * | 2015-12-02 | 2017-08-04 | 歌尔股份有限公司 | 一种双足机器人的步态控制方法和装置 |
CN109955928B (zh) * | 2017-12-25 | 2020-10-16 | 深圳市优必选科技有限公司 | 一种双足机器人及其等效轨迹生成方法和装置 |
CN109987169B (zh) * | 2017-12-29 | 2021-01-08 | 深圳市优必选科技有限公司 | 双足机器人的步态控制方法、装置、终端设备及介质 |
CN108582066B (zh) * | 2018-03-13 | 2021-09-03 | 同济大学 | 一种分层cpg及在仿人机器人行走控制中的应用 |
CN108469732A (zh) * | 2018-03-13 | 2018-08-31 | 同济大学 | 基于dmp的机器人工作空间适应性行走控制系统及方法 |
CN111252162B (zh) * | 2020-02-24 | 2021-07-23 | 北京理工大学 | 一种双足机器人足部柔顺平衡控制系统及方法 |
CN111558941B (zh) * | 2020-07-14 | 2020-09-29 | 深圳市优必选科技股份有限公司 | 浮动基动力学前馈控制方法、装置和多足机器人 |
CN113359800A (zh) * | 2021-06-30 | 2021-09-07 | 深圳市优必选科技股份有限公司 | 机器人行走控制方法、装置、机器人控制设备及存储介质 |
-
2021
- 2021-06-30 CN CN202110739449.XA patent/CN113359800A/zh active Pending
- 2021-11-17 WO PCT/CN2021/131191 patent/WO2023273107A1/zh unknown
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001198865A (ja) * | 2000-01-20 | 2001-07-24 | Toshiba Corp | 2足歩行ロボット装置およびその運用方法 |
WO2004051414A2 (en) * | 2002-11-27 | 2004-06-17 | Edc Biosystems, Inc. | Wave guide with isolated coupling interface |
US20060197485A1 (en) * | 2003-04-17 | 2006-09-07 | Honda Motor Co., Ltd. | Method of assuming acting point of floor reaction force to biped walking mobile body and method of assuming joint moment of biped walking mobile body |
US20060173578A1 (en) * | 2003-06-27 | 2006-08-03 | Honda Motor Co., Ltd. | Controller of legged mobile robot |
US20110196532A1 (en) * | 2007-12-17 | 2011-08-11 | Korea Institute Of Science And Technology | Apparatus and method for balancing and damping control in whole body coordination framework for biped humanoid robot |
US20090281661A1 (en) * | 2008-04-24 | 2009-11-12 | Evolution Robotics | Application of localization, positioning & navigation systems for robotic enabled mobile products |
EP2384863A2 (en) * | 2010-01-21 | 2011-11-09 | Institutul de Mecanica Solidelor al Academiei Romane | Method and device for dynamic control of a walking robot |
US20120245734A1 (en) * | 2011-03-21 | 2012-09-27 | Seungkook Yun | Humanoid robot push recovery on level and non-level ground |
CN103101060A (zh) * | 2011-11-11 | 2013-05-15 | 鸿富锦精密工业(深圳)有限公司 | 机器人工具中心点的传感校正方法 |
CN104331081A (zh) * | 2014-10-10 | 2015-02-04 | 北京理工大学 | 一种双足机器人斜面行走的步态规划方法 |
CN113050616A (zh) * | 2019-12-27 | 2021-06-29 | 深圳市优必选科技股份有限公司 | 一种双足机器人行走的控制方法及双足机器人 |
CN111880544A (zh) * | 2020-08-07 | 2020-11-03 | 深圳市优必选科技股份有限公司 | 仿人机器人步态规划方法、装置和仿人机器人 |
CN113021299A (zh) * | 2021-04-13 | 2021-06-25 | 山东大学 | 一种双腿轮复合机器人全方位运动控制方法 |
Non-Patent Citations (6)
Title |
---|
DAOJIN YAO 等: "《Feedforward control for underactuated bipedal walking on compliant continuous steps with varying height》", 《ORIGINAL ARTICLE》, pages 1 - 13 * |
HYUN-MIN JOE 等: "《Balance recovery through model predictive control based on capture point dynamics for biped walking robot》", 《ROBOTICS AND AUTONOMOUS SYSTEMS》, pages 1 - 10 * |
JIANJUN YU 等: "《Walking Simulation of Biped Robot on Inclined Plane Based on Gait Recognition》", 《PROCEEDINGS OF THE 2020 IEEE INTERNATIONAL CONFERENCE ON REAL-TIME COMPUTING AND ROBOTICS》, pages 1 - 6 * |
常琦 等: "《仿人机器人斜坡行走的步态规划》", 《计算机技术与发展》, pages 1 - 5 * |
朱雅乔 等: "《灾害现场被动自适应救援机器人运动学分析》", 《北京工业职业技术学院学报》, pages 1 - 6 * |
毕盛 等: "《一种仿人机器人斜坡运动步态规划方法》", 《华南理工大学学报(自然科学版)》, vol. 38, no. 11, pages 1 - 8 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113064433B (zh) * | 2021-03-22 | 2023-08-18 | 深圳市优必选科技股份有限公司 | 机器人迈步控制方法、装置、机器人控制设备及存储介质 |
CN113064433A (zh) * | 2021-03-22 | 2021-07-02 | 深圳市优必选科技股份有限公司 | 机器人迈步控制方法、装置、机器人控制设备及存储介质 |
WO2023273107A1 (zh) * | 2021-06-30 | 2023-01-05 | 深圳市优必选科技股份有限公司 | 机器人行走控制方法、装置、机器人控制设备及存储介质 |
CN114237212A (zh) * | 2021-10-15 | 2022-03-25 | Oppo广东移动通信有限公司 | 足式机器人移动方法、装置、存储介质及电子设备 |
CN114115280A (zh) * | 2021-11-29 | 2022-03-01 | 深圳市优必选科技股份有限公司 | 四足奔跑步态规划方法、装置及机器人控制设备 |
CN114115280B (zh) * | 2021-11-29 | 2024-03-29 | 深圳市优必选科技股份有限公司 | 四足奔跑步态规划方法、装置及机器人控制设备 |
CN114253260B (zh) * | 2021-12-08 | 2023-08-18 | 深圳市优必选科技股份有限公司 | 机器人步态规划方法及装置、运动规划设备和存储介质 |
CN114253260A (zh) * | 2021-12-08 | 2022-03-29 | 深圳市优必选科技股份有限公司 | 机器人步态规划方法及装置、运动规划设备和存储介质 |
CN114115295B (zh) * | 2021-12-28 | 2023-08-18 | 深圳市优必选科技股份有限公司 | 机器人运动规划方法及装置、机器人控制设备和存储介质 |
CN114115295A (zh) * | 2021-12-28 | 2022-03-01 | 深圳市优必选科技股份有限公司 | 机器人运动规划方法及装置、机器人控制设备和存储介质 |
CN114489104A (zh) * | 2022-01-21 | 2022-05-13 | 深圳市优必选科技股份有限公司 | 机器人迈步控制方法及装置、机器人控制设备和存储介质 |
CN114489104B (zh) * | 2022-01-21 | 2023-11-10 | 深圳市优必选科技股份有限公司 | 机器人迈步控制方法及装置、机器人控制设备和存储介质 |
WO2024021744A1 (zh) * | 2022-07-25 | 2024-02-01 | 腾讯科技(深圳)有限公司 | 一种控制足式机器人的方法、装置、电子设备、计算机可读存储介质、计算机程序产品及足式机器人 |
CN115533924A (zh) * | 2022-12-01 | 2022-12-30 | 北京航空航天大学杭州创新研究院 | 协同运动控制方法及装置、机器人控制设备和存储介质 |
CN116149204A (zh) * | 2023-04-19 | 2023-05-23 | 五八智能科技(杭州)有限公司 | 一种双足机器人的动力学建模与控制方法 |
CN116149204B (zh) * | 2023-04-19 | 2023-10-10 | 五八智能科技(杭州)有限公司 | 一种双足机器人的动力学建模与控制方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2023273107A1 (zh) | 2023-01-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113359800A (zh) | 机器人行走控制方法、装置、机器人控制设备及存储介质 | |
CN111891252B (zh) | 一种四足仿生机器人的身体姿态斜坡自适应控制方法 | |
JP3269852B2 (ja) | 脚式移動ロボットの姿勢安定化制御装置 | |
JP5950234B2 (ja) | 非水平および非定常の地面上にいる人型ロボットの運動量基準型バランス制御装置 | |
JP5845334B2 (ja) | ロボット制御方法および記憶媒体 | |
CN111880544A (zh) | 仿人机器人步态规划方法、装置和仿人机器人 | |
US8793019B2 (en) | Control device for legged mobile robot | |
US7482775B2 (en) | Robot controller | |
US8108070B2 (en) | Robot and control method thereof | |
JP5284923B2 (ja) | 脚式移動ロボットの制御装置 | |
Yi et al. | Online learning of a full body push recovery controller for omnidirectional walking | |
EP1547732A1 (en) | Robot device and control method of robot device | |
US8340817B2 (en) | Legged robot and its control method | |
WO2009067458A1 (en) | Learning capture points for humanoid push recovery | |
CN113753150A (zh) | 轮腿式机器人的控制方法、装置、设备及可读存储介质 | |
CN113290559B (zh) | 机器人平衡控制方法、装置、机器人控制设备及存储介质 | |
JP2011093025A (ja) | 脚式移動ロボットの制御装置 | |
Dafarra et al. | A control architecture with online predictive planning for position and torque controlled walking of humanoid robots | |
JP6781101B2 (ja) | 非線形システムの制御方法、二足歩行ロボットの制御装置、二足歩行ロボットの制御方法及びそのプログラム | |
CN114625129B (zh) | 位控腿足机器人的运动控制方法及系统 | |
JP4483254B2 (ja) | ロボット装置及びロボット装置の制御方法 | |
CN108803641B (zh) | 飞行控制方法及飞行器 | |
CN114489104B (zh) | 机器人迈步控制方法及装置、机器人控制设备和存储介质 | |
CN116237943A (zh) | 一种结合地形约束的四足机器人控制方法 | |
JP2007007803A (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 |