[发明专利]机器人的行走控制方法、装置、机器人和可读存储介质有效
申请号: | 201911399923.8 | 申请日: | 2019-12-30 |
公开(公告)号: | CN113119097B | 公开(公告)日: | 2022-07-29 |
发明(设计)人: | 郭宜劼;赵明国;熊友军 | 申请(专利权)人: | 深圳市优必选科技股份有限公司 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 北京超凡宏宇专利代理事务所(特殊普通合伙) 11463 | 代理人: | 梁韬 |
地址: | 518000 广东省深圳市南山区*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 行走 控制 方法 装置 机器 人和 可读 存储 介质 | ||
1.一种机器人的行走控制方法,其特征在于,所述行走控制方法包括:
判断当前规划步中所述机器人的腰部相对于支撑脚的前向水平规划速度是否大于预设速度阈值;
当所述前向水平规划速度大于所述预设速度阈值时,通过正运动学计算获取所述当前规划步中所述腰部相对于支撑脚的前向水平位置作为当前驱动变量,并计算获取所述机器人各关节关于所述当前驱动变量的各自对应的轨迹规划函数;
比较所述腰部相对于支撑脚的前向水平实测速度与所述前向水平规划速度的大小;
当所述前向水平实测速度大于所述前向水平规划速度时,按照所述前向水平实测速度对所述当前驱动变量和所述轨迹规划函数进行更新以实现对所述机器人的行走控制;
当所述前向水平实测速度小于或等于前向水平规划速度时,按照所述前向水平规划速度对所述当前驱动变量和所述轨迹规划函数进行更新以实现对所述机器人的行走控制。
2.根据权利要求1所述的行走控制方法,其特征在于,所述按照所述前向水平实测速度对所述当前驱动变量和所述轨迹规划函数进行更新以实现对所述机器人的行走控制的步骤包括:
根据所述前向水平实测速度对所述当前驱动变量进行更新以得到第一目标驱动变量;
根据所述第一目标驱动变量对所述机器人各关节轨迹规划函数进行更新以得到各自对应的目标轨迹规划函数;
按照各自对应的目标轨迹规划函数驱动所述机器人各关节以实现所述机器人的行走控制。
3.根据权利要求1所述的行走控制方法,其特征在于,所述按照所述前向水平规划速度对所述当前驱动变量和所述轨迹规划函数进行更新以实现对所述机器人的行走控制的步骤包括:
根据所述前向水平规划速度对所述当前驱动变量进行更新以得到第二目标驱动变量;
根据所述第二目标驱动变量对所述机器人各关节轨迹规划函数进行更新以得到各自对应的目标轨迹规划函数;
按照各自对应的目标轨迹规划函数驱动所述机器人各关节以实现所述机器人的行走控制。
4.根据权利要求1所述的行走控制方法,其特征在于,所述行走控制方法还包括:
根据摆动腿前向规划位置、所述前向水平实测速度、所述前向水平规划速度以及上一规划步中上一驱动变量在与所述当前驱动变量相同时所对应的前向水平实测速度计算摆动腿前向校正位置以实现所述机器人的行走控制。
5.根据权利要求4所述的行走控制方法,其特征在于,所述计算摆动腿前向校正位置的计算公式为:
其中,xsw(s)表示摆动腿前向校正位置,xswd(s)表示摆动腿前向规划位置,表示所述前向水平实测速度,表示所述前向水平规划速度,表示上一规划步中上一驱动变量在与所述当前驱动变量相同时所对应的前向水平实测速度,p1表示第一预设误差调节因子,d1表示第二预设误差调节因子。
6.根据权利要求1所述的行走控制方法,其特征在于,所述行走控制方法还包括:
根据摆动腿侧向规划位置、所述腰部相对于支撑脚的侧向水平规划速度、所述腰部相对于支撑脚的侧向水平实测速度以及上一规划步中上一驱动变量在与所述当前驱动变量相同时所对应的所述腰部相对于支撑脚的侧向水平实测速度计算摆动腿侧向校正位置以实现所述机器人的行走控制。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市优必选科技股份有限公司,未经深圳市优必选科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911399923.8/1.html,转载请声明来源钻瓜专利网。