[发明专利]机器人迈步控制方法、装置、机器人控制设备及存储介质有效
申请号: | 202110303627.4 | 申请日: | 2021-03-22 |
公开(公告)号: | CN113064433B | 公开(公告)日: | 2023-08-18 |
发明(设计)人: | 陈春玉;白杰;刘益彰;葛利刚;谢铮;熊友军 | 申请(专利权)人: | 深圳市优必选科技股份有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02;B62D57/032 |
代理公司: | 北京超凡宏宇专利代理事务所(特殊普通合伙) 11463 | 代理人: | 梁韬 |
地址: | 518000 广东省深圳市南山区*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 迈步 控制 方法 装置 设备 存储 介质 | ||
本申请提供一种机器人迈步控制方法、装置、机器人控制设备及存储介质,涉及机器人控制技术领域。本申请在检测到双足机器人当前处于非平衡状态的情况下,会相应地获取双足机器人当前的机体平衡预测步长,并根据所述双足机器人当前移动步长对所述机体平衡预测步长进行平滑过渡处理,得到与所述机体平衡预测步长对应的平衡期望步长,继而得到与平衡期望步长对应的腿部规划轨迹,最后控制双足机器人当前的摆动腿按照腿部规划轨迹进行运动,从而使双足机器人能够恢复到平衡状态,并避免出现机器人迈步阶跃现象,提升机器人运行可靠性。
技术领域
本申请涉及机器人控制技术领域,具体而言,涉及一种机器人迈步控制方法、装置、机器人控制设备及存储介质。
背景技术
随着科学技术的不断发展,机器人技术因具有极大的研究价值及应用价值受到了各行各业的广泛重视,其中双足机器人控制便是机器人控制技术领域中的一项重要研究方向。而在双足机器人的实际控制过程中,双足机器人通常会受到外部干扰(例如,外部推动、外界大风环境干扰等)和/或内部干扰(例如,机器人头部重量增加、机器人手臂断开等)而存在失稳现象,无法保持平衡状态。
发明内容
有鉴于此,本申请的目的在于提供一种机器人迈步控制方法、装置、机器人控制设备及存储介质,能够对机器人维稳步长所对应的迈步轨迹进行平滑处理,使双足机器人在按照处理后的迈步轨迹运行后对应恢复平衡状态的同时,避免出现双足机器人迈步阶跃现象,提升机器人运行可靠性。
为了实现上述目的,本申请实施例采用的技术方案如下:
第一方面,本申请提供一种机器人迈步控制方法,所述方法包括:
检测双足机器人当前是否处于非平衡状态;
在检测到所述双足机器人当前处于非平衡状态的情况下,获取所述双足机器人当前对应的机体平衡预测步长;
根据所述双足机器人当前移动步长对所述机体平衡预测步长进行平滑过渡处理,得到与所述机体平衡预测步长对应的平衡期望步长;
根据所述平衡期望步长确定所述双足机器人当前的腿部规划轨迹;
控制所述双足机器人当前的摆动腿按照所述腿部规划轨迹进行运动。
在可选的实施方式中,所述移动步长包括所述双足机器人在俯仰方向以及横滚方向上各自相对于水平面的现用步长,所述机体平衡预测步长包括所述双足机器人在俯仰方向以及横滚方向上各自相对于水平面的预估步长,所述平衡期望步长包括所述双足机器人在俯仰方向以及横滚方向上各自相对于水平面的待实现步长,其中归属于俯仰方向的现用步长、预估步长、待实现步长相互对应,归属于横滚方向的现用步长、预估步长、待实现步长相互对应;
所述根据所述双足机器人当前移动步长对所述机体平衡预测步长进行平滑过渡处理,得到与所述机体平衡预测步长对应的平衡期望步长的步骤,包括:
针对所述移动步长所包括的每个现用步长,计算该现用步长与对应预估步长之间的步长差值;
根据所述步长差值、与该现用步长所属移动方向对应的当前步移速度、预设位置影响系数以及预设速度影响系数,计算与所述对应预估步长匹配的期望加速度,其中所述预设位置影响系数用于表示对应步长差值在预估步长平滑过程中的影响权重数值,所述预设速度影响系数用于表示对应当前步移速度在预估步长平滑过程中的影响权重数值;
根据所述当前步移速度、所述期望加速度以及所述双足机器人的迈步控制帧时长,计算与所述对应预估步长匹配的期望步移速度;
根据该现用步长、所述期望步移速度和所述迈步控制帧时长,计算所述双足机器人当前与所述对应预估步长对应的待实现步长。
在可选的实施方式中,所述腿部规划轨迹采用如下方程组进行表达:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市优必选科技股份有限公司,未经深圳市优必选科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110303627.4/2.html,转载请声明来源钻瓜专利网。