当前位置: 首页 > 专利查询>之江实验室专利>正文

一种双足机器人上下台阶的控制方法及控制装置制造方法及图纸

技术编号:39245478 阅读:7 留言:0更新日期:2023-10-30 11:57
本说明书公开了一种双足机器人上下台阶的控制方法及控制装置,确定双足机器人的摆动脚在上下台阶的过程中垂直方向上的移动轨迹是以期望曲线为约束条件,这一期望曲线可以保证双足机器人的摆动脚在上下台阶的过程中不至于抬的过高,也不会碰撞到台阶的边沿,从而可以保证双足机器人在上下台阶的过程中,可以平稳行进。平稳行进。平稳行进。

【技术实现步骤摘要】
一种双足机器人上下台阶的控制方法及控制装置


[0001]本说明书涉及人工智能领域,尤其涉及一种双足机器人上下台阶的控制方法及控制装置。

技术介绍

[0002]双足机器人是一种模仿人类的外形结构、行走方式等功能的仿生机器人,集成了控制、语音、视觉、云脑、人工智能等多个研究方向,系统复杂,技术前沿,在娱乐、服务、辅助等领域具有广阔的应用前景。
[0003]双足机器人采用腿式结构,具有更好的地形适应能力,易实现越障、上下台阶功能。但是,相比于平地行走,在上下台阶的过程中,双足机器人的质心高度会发生变化。按照台阶的设计标准,台阶宽度不宜小于0.3m,因此对连续上下台阶的双足机器人,沿着前进方向的步长比平地行走大,很难实现动态稳定。而且,由于台阶有一定高度,所以双足机器人的摆动腿需要抬得更高以保证不与台阶的边沿发生碰撞,这更容易导致双足机器人的质心不稳定,甚至失去平衡而摔倒。
[0004]所以,如何能够保证双足机器人在上下台阶的过程中,实现平稳的行进,则是一个亟待解决的问题。

技术实现思路

[0005]本说明书提供一种双足机器人上下台阶的控制方法及控制装置,以部分的解决现有技术存在的上述问题。
[0006]本说明书采用下述技术方案:本说明书提供了一种双足机器人上下台阶的控制方法,包括:获取双足机器人在当前的状态信息;根据所述状态信息,确定所述双足机器人在上下台阶的过程中所述双足机器人的质心在水平方向上的移动轨迹;根据所述移动轨迹,以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的移动轨迹满足预设期望曲线为约束条件,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹;根据所述移动轨迹以及所述控制轨迹,控制所述双足机器人进行上下台阶。
[0007]可选地,根据所述状态信息,确定所述双足机器人在上下台阶的过程中所述双足机器人的质心在水平方向上的移动轨迹,具体包括:根据所述状态信息,确定所述双足机器人在上下台阶的过程中水平方向上的零力矩点位置;以最小化所述双足机器人在上下台阶的过程中水平方向上的零力矩点位置与期望的零力矩点位置之间的偏差为约束条件,确定所述双足机器人的控制增益;根据所述双足机器人在上下台阶的过程中水平方向上的零力矩点位置以及所述
控制增益,确定所述双足机器人在上下台阶的过程中所述双足机器人的质心在水平方向上的移动轨迹。
[0008]可选地,根据所述移动轨迹,以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的移动轨迹满足预设期望曲线为约束条件,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹,具体包括:若确定所述双足机器人采用第一行进方式进行上下台阶时,针对每个第一行进周期,根据所述移动轨迹以及台阶的高度,确定在该第一行进周期中所述双足机器人的质心在上下台阶的过程中垂直方向上的移动轨迹,作为该第一行进周期对应的质心移动轨迹,所述双足机器人的两脚在一个第一行进周期中上一个台阶或是下一个台阶,所述第一行进方式为所述双足机器人两脚先后上同一台阶或两脚先后下同一台阶;以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹满足预设期望曲线为约束条件,根据每个第一行进周期对应的质心移动轨迹,确定所述控制轨迹。
[0009]可选地,根据所述移动轨迹,以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的移动轨迹满足预设期望曲线为约束条件,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹,具体包括:若确定所述双足机器人采用第二行进方式进行上下台阶时,针对每个第二行进周期,根据所述移动轨迹以及台阶的高度,确定在该第二行进周期中所述双足机器人的质心在上下台阶的过程中垂直方向上的移动轨迹,作为该第二行进周期对应的质心移动轨迹,所述双足机器人的两脚在一个第二行进周期中上两个台阶或是下两个台阶,所述第二行进方式为所述双足机器人两脚交替上相邻的两个台阶或两脚交替下相邻的两个台阶;以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的移动轨迹满足预设期望曲线为约束条件,根据每个第二行进周期对应的质心移动轨迹,确定所述控制轨迹。
[0010]可选地,根据所述移动轨迹,以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹满足预设期望曲线为约束条件,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹,具体包括:针对每个台阶,根据该台阶的高度,确定所述双足机器人的摆动脚在上该台阶或是下该台阶的过程中产生的每个控制点在垂直方向上所对应的补偿值,以及根据所述期望曲线以及所述双足机器人的摆动脚在上该台阶或是下该台阶的过程中的步长,确定每个控制点对应的基础位置;根据每个控制点对应的基础位置以及每个控制点在垂直方向上对应的补偿值,确定在上该台阶或是下该台阶的过程中所述双足机器人的摆动脚的控制轨迹,作为该台阶对应的控制轨迹;根据每个台阶对应的控制轨迹,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹。
[0011]本说明书提供了一种双足机器人上下台阶的控制装置,包括:获取模块,用于获取双足机器人在当前的状态信息;第一确定模块,用于根据所述状态信息,确定所述双足机器人在上下台阶的过程中所述双足机器人的质心在水平方向上的移动轨迹;第二确定模块,用于根据所述移动轨迹,以所述双足机器人的摆动脚在上下台阶
的过程中垂直方向上的移动轨迹满足预设期望曲线为约束条件,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹;控制模块,用于根据所述移动轨迹以及所述控制轨迹,控制所述双足机器人进行上下台阶。
[0012]可选地,所述第一确定模块具体用于,根据所述状态信息,确定所述双足机器人在上下台阶的过程中水平方向上的零力矩点位置;以最小化所述双足机器人在上下台阶的过程中水平方向上的零力矩点位置与期望的零力矩点位置之间的偏差为约束条件,确定所述双足机器人的控制增益;根据所述双足机器人在上下台阶的过程中水平方向上的零力矩点位置以及所述控制增益,确定所述双足机器人在上下台阶的过程中所述双足机器人的质心在水平方向上的移动轨迹。
[0013]可选地,所述第二确定模块具体用于,针对每个台阶,根据该台阶的高度,确定所述双足机器人的摆动脚在上该台阶或是下该台阶的过程中产生的每个控制点在垂直方向上所对应的补偿值,以及根据所述期望曲线以及所述双足机器人的摆动脚在上该台阶或是下该台阶的过程中的步长,确定每个控制点对应的基础位置;根据每个控制点对应的基础位置以及每个控制点在垂直方向上对应的补偿值,确定在上该台阶或是下该台阶的过程中所述双足机器人的摆动脚的控制轨迹,作为该台阶对应的控制轨迹;根据每个台阶对应的控制轨迹,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹。
[0014]本说明书提供了一种计算机可读存储介质,所述存储介质存储有计算机程序,所述计算机程序被处理器执行时实现上述双足机器人上下台阶的控制方法。
[0015]本说明书提供了一种电子设备,包括存储器、处理器及存储在存储器上并可在处本文档来自技高网
...

【技术保护点】

【技术特征摘要】
1.一种双足机器人上下台阶的控制方法,其特征在于,包括:获取双足机器人在当前的状态信息;根据所述状态信息,确定所述双足机器人在上下台阶的过程中所述双足机器人的质心在水平方向上的移动轨迹;根据所述移动轨迹,以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的移动轨迹满足预设期望曲线为约束条件,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹;根据所述移动轨迹以及所述控制轨迹,控制所述双足机器人进行上下台阶。2.如权利要求1所述的方法,其特征在于,根据所述状态信息,确定所述双足机器人在上下台阶的过程中所述双足机器人的质心在水平方向上的移动轨迹,具体包括:根据所述状态信息,确定所述双足机器人在上下台阶的过程中水平方向上的零力矩点位置;以最小化所述双足机器人在上下台阶的过程中水平方向上的零力矩点位置与期望的零力矩点位置之间的偏差为约束条件,确定所述双足机器人的控制增益;根据所述双足机器人在上下台阶的过程中水平方向上的零力矩点位置以及所述控制增益,确定所述双足机器人在上下台阶的过程中所述双足机器人的质心在水平方向上的移动轨迹。3.如权利要求1所述的方法,其特征在于,根据所述移动轨迹,以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的移动轨迹满足预设期望曲线为约束条件,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹,具体包括:若确定所述双足机器人采用第一行进方式进行上下台阶时,针对每个第一行进周期,根据所述移动轨迹以及台阶的高度,确定在该第一行进周期中所述双足机器人的质心在上下台阶的过程中垂直方向上的移动轨迹,作为该第一行进周期对应的质心移动轨迹,所述双足机器人的两脚在一个第一行进周期中上一个台阶或是下一个台阶,所述第一行进方式为所述双足机器人两脚先后上同一台阶或两脚先后下同一台阶;以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹满足预设期望曲线为约束条件,根据每个第一行进周期对应的质心移动轨迹,确定所述控制轨迹。4.如权利要求1所述的方法,其特征在于,根据所述移动轨迹,以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的移动轨迹满足预设期望曲线为约束条件,确定所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的控制轨迹,具体包括:若确定所述双足机器人采用第二行进方式进行上下台阶时,针对每个第二行进周期,根据所述移动轨迹以及台阶的高度,确定在该第二行进周期中所述双足机器人的质心在上下台阶的过程中垂直方向上的移动轨迹,作为该第二行进周期对应的质心移动轨迹,所述双足机器人的两脚在一个第二行进周期中上两个台阶或是下两个台阶,所述第二行进方式为所述双足机器人两脚交替上相邻的两个台阶或两脚交替下相邻的两个台阶;以所述双足机器人的摆动脚在上下台阶的过程中垂直方向上的移动轨迹满足预设期望曲线为约束条件,根据每个第二行进周期对应的质心移动轨迹,确定所述控制轨迹。5.如权利要求1所述的方法,其特征在于,根据所述移动轨迹,以...

【专利技术属性】
技术研发人员:唐敬阁吴国藩王凡王鑫吴义健王鹏留云梁定坤谢安桓朱世强
申请(专利权)人:之江实验室
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1