[发明专利]仿人机器人的类人步态控制方法、装置、设备及存储介质在审
申请号: | 202011487389.9 | 申请日: | 2020-12-16 |
公开(公告)号: | CN112698650A | 公开(公告)日: | 2021-04-23 |
发明(设计)人: | 白杰;陈春玉;葛利刚;刘益彰;熊友军 | 申请(专利权)人: | 深圳市优必选科技股份有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 深圳中细软知识产权代理有限公司 44528 | 代理人: | 孔祥丹 |
地址: | 518000 广东省深圳市南山区*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 人机 步态 控制 方法 装置 设备 存储 介质 | ||
1.一种仿人机器人的类人步态控制方法,其特征在于,所述方法包括:
获取所述仿人机器人当前时刻的虚拟质心到左腿踝关节的第一向量和所述虚拟质心到右腿踝关节的第二向量,及获取所述仿人机器人当前时刻的虚拟质心原始规划值;
根据所述第一向量、第二向量、虚拟质心原始规划值及预设的降低虚拟质心高度算法,确定所述仿人机器人当前时刻虚拟质心降低后的目标虚拟质心高度;
根据所述目标虚拟质心高度控制所述仿人机器人进行直膝行走。
2.根据权利要求1所述的方法,其特征在于,所述根据所述第一向量、第二向量、虚拟质心原始规划值及预设的降低虚拟质心高度算法,确定所述仿人机器人当前时刻虚拟质心降低后的目标虚拟质心高度,包括:
获取所述仿人机器人的大腿长度及小腿长度,及计算所述第一向量和第二向量在所述仿人机器人的行走方向上的第一分量和第二分量;
基于所述降低虚拟质心高度算法,根据所述大腿长度、小腿长度、所述第一分量及第二分量确定所述仿人机器人在当前时刻的虚拟质心降低值;
利用所述虚拟质心原始规划值及所述虚拟质心降低值,确定所述目标虚拟质心高度。
3.根据权利要求1所述方法,其特征在于,所述根据所述目标虚拟质心高度控制所述仿人机器人进行直膝行走,之前还包括:
确定所述仿人机器人当前时刻在直膝行走周期内所处的目标时期,所述目标时期为双腿支撑期或者为单腿支撑期;
当所述目标阶段为单腿支撑期,确定所述仿人机器人的支撑腿及摆动腿;
确定所述摆动腿在当前时刻所处的迈步阶段,所述迈步阶段包括摆动腿抬脚阶段、摆动腿腾空阶段及摆动腿落脚阶段;
根据所述摆动腿在当前时刻所处的迈步阶段,确定所述摆动腿的目标俯仰角;
则所述根据所述目标虚拟质心高度控制所述仿人机器人进行直膝行走,包括:
根据所述目标虚拟质心高度控制所述仿人机器人进行直膝行走,且同时控制所述摆动腿的脚掌按照所述目标俯仰角进行脚掌翻转。
4.根据权利3所述方法,其特征在于,所述确定所述摆动腿在当前时刻所处的迈步阶段,包括:
获取当前时刻所述虚拟质心到所述摆动腿的向量在行进方向上的目标分量;
当所述目标分量与预设步长的比值大于或等于预设第一系数,且小于预设第二系数,则确定当前时刻所处的迈步阶段为摆动腿抬脚阶段;
当所述目标分量与预设步长的比值大于或等于预设第二系数,且小于预设第三系数,则确定当前时刻所处的迈步阶段为摆动腿腾空阶段;
当所述目标分量与预设步长的比值大于或等于预设第三系数,且小于预设第四系数,则确定当前时刻所处的迈步阶段为摆动腿落脚阶段;
其中,所述第一系数、第二系数、第三系数及第四系数依次递增,且均大于-1小于1。
5.根据权利要求4所述方法,其特征在于,所述根据所述摆动腿在当前时刻所处的迈步阶段,确定所述摆动腿的目标俯仰角,包括:
若所述摆动腿在当前时刻所处的迈步阶段为摆动腿抬脚阶段,则利用所述比值及预设第一俯仰角算法确定所述摆动腿的目标俯仰角,所述预设第一俯仰角算法为俯仰角随系数增大的第一算法;
若所述摆动腿在当前时刻所处的迈步阶段为摆动腿腾空阶段,则利用所述比值及预设第二俯仰角算法确定所述摆动腿的目标俯仰角,所述预设第二俯仰角算法为俯仰角随预设系数减小的第二算法;
若所述摆动腿在当前时刻所处的迈步阶段为摆动腿落脚阶段,则利用所述比值及预设第三俯仰角算法确定所述摆动腿的目标俯仰角,所述预设第三俯仰角算法为俯仰角随系数增大的第三算法。
6.根据权利要求3所述方法,其特征在于,所述控制所述摆动腿的脚掌按照所述目标俯仰角进行脚掌翻转,包括:
根据所述目标俯仰角,确定当前时刻所述摆动腿的脚踝到支撑点的位置矢量;
根据所述位置矢量和所述目标俯仰角,确定当前时刻摆动腿的脚踝的修正后的目标期望角度,所述修正后的目标期望角度为踝关节旋转角度;
按照所述修正后的目标期望角度控制进行脚掌翻转。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市优必选科技股份有限公司,未经深圳市优必选科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011487389.9/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种智能制造高强度防风移动通信信号塔
- 下一篇:可调变高低牛耳织带织造工艺