[发明专利]机器人迈步控制方法及装置、机器人控制设备和存储介质在审
申请号: | 202210074131.9 | 申请日: | 2022-01-21 |
公开(公告)号: | CN114489104A | 公开(公告)日: | 2022-05-13 |
发明(设计)人: | 葛利刚;刘益彰;罗秋月;陈春玉;罗璇;周江琛 | 申请(专利权)人: | 深圳市优必选科技股份有限公司 |
主分类号: | G05D1/08 | 分类号: | G05D1/08 |
代理公司: | 北京超凡宏宇专利代理事务所(特殊普通合伙) 11463 | 代理人: | 马泽伟 |
地址: | 518000 广东省深圳市南山区*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 迈步 控制 方法 装置 设备 存储 介质 | ||
本申请提供一种机器人迈步控制方法及装置、机器人控制设备和存储介质,涉及机器人控制技术领域。本申请根据双足机器人当前的零力矩点规划数据以及双足实际位置数据,确定双足期望支撑力,而后根据双足期望支撑力和当前的质心移动规划数据、质心实际移动数据、双足迈步规划数据及双足实际受力数据,基于柔顺控制算法确定双足踝关节当前的期望关节姿态角,以及与实际足部支撑状态匹配的期望关节位置,从而得以根据双足机器人的实际运动状况对足部期望位姿状况进行全方位柔顺控制,使足部期望位置和足部期望姿态均与实际地面状况实质匹配,以降低单足支撑期的落足冲击力和双足支撑期的足间内力,提升双足机器人的行走稳定性和地形适应力。
技术领域
本申请涉及机器人控制技术领域,具体而言,涉及一种机器人迈步控制方法及装置、机器人控制设备和存储介质。
背景技术
随着科学技术的不断发展,机器人技术因具有极大的研究价值及应用价值受到了各行各业的广泛重视,其中双足机器人控制便是机器人控制技术领域中的一项重要研究方向。
而在双足机器人的行走控制过程中,往往会因步态规划模型简化、机械结构形变以及地面不平整等因素,导致双足机器人按照规划好的步行轨迹迈步时的足部位姿状况与实际地面状况不匹配,使双足机器人在单足支撑状态时的落足与地面发生严重碰撞冲击,并使双足机器人在双足支撑状态时产生较大的足间内力,严重影响双足机器人的行走稳定性。
发明内容
有鉴于此,本申请的目的在于提供一种机器人迈步控制方法及装置、机器人控制设备和存储介质,能够根据双足机器人的实际运动状况对双足机器人的足部期望位姿状况进行全方位柔顺控制,使足部期望位置和足部期望姿态均与实际地面状况实质匹配,以降低双足机器人在单足支撑期时的落足冲击力和在双足支撑期时的足间内力,提升双足机器人的行走稳定性和地形适应力。
为了实现上述目的,本申请实施例采用的技术方案如下:
第一方面,本申请提供一种机器人迈步控制方法,所述方法包括:
获取双足机器人当前的质心移动规划数据、双足迈步规划数据以及零力矩点规划数据,以及所述双足机器人当前的实际足部支撑状态、质心实际移动数据、双足实际位置数据和双足实际受力数据;
根据所述零力矩点规划数据以及所述双足实际位置数据,计算所述双足机器人当前的双足期望支撑力;
根据所述双足期望支撑力、所述质心移动规划数据、所述质心实际移动数据以及所述双足实际受力数据,基于柔顺控制算法计算所述双足机器人的双足踝关节当前的期望关节姿态角;
根据所述双足迈步规划数据、所述双足期望支撑力及所述双足实际受力数据,基于柔顺控制算法计算所述双足踝关节当前的与所述实际足部支撑状态匹配的期望关节位置;
按照所述双足踝关节的期望关节姿态角及期望关节位置控制所述双足机器人进行迈步运动。
第二方面,本申请提供一种机器人迈步控制装置,所述装置包括:
迈步数据获取模块,用于获取双足机器人当前的质心移动规划数据、双足迈步规划数据以及零力矩点规划数据,以及所述双足机器人当前的实际足部支撑状态、质心实际移动数据、双足实际位置数据和双足实际受力数据;
双足支撑计算模块,用于根据所述零力矩点规划数据以及所述双足实际位置数据,计算所述双足机器人当前的双足期望支撑力;
双足姿态计算模块,用于根据所述双足期望支撑力、所述质心移动规划数据、所述质心实际移动数据以及所述双足实际受力数据,基于柔顺控制算法计算所述双足机器人的双足踝关节当前的期望关节姿态角;
双足位置计算模块,用于根据所述双足迈步规划数据、所述双足期望支撑力及所述双足实际受力数据,基于柔顺控制算法计算所述双足踝关节当前的与所述实际足部支撑状态匹配的期望关节位置;
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市优必选科技股份有限公司,未经深圳市优必选科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202210074131.9/2.html,转载请声明来源钻瓜专利网。