[发明专利]一种机器人的弹跳控制方法、装置、介质、电子设备在审
| 申请号: | 202310115209.1 | 申请日: | 2023-01-29 |
| 公开(公告)号: | CN116088553A | 公开(公告)日: | 2023-05-09 |
| 发明(设计)人: | 冷晓琨;常琳;何治成;吴雨璁;白学林;柯真东;王松;黄贤贤 | 申请(专利权)人: | 乐聚(深圳)机器人技术有限公司 |
| 主分类号: | G05D1/08 | 分类号: | G05D1/08 |
| 代理公司: | 北京三聚阳光知识产权代理有限公司 11250 | 代理人: | 王开慧 |
| 地址: | 518000 广东省深圳市*** | 国省代码: | 广东;44 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 机器人 弹跳 控制 方法 装置 介质 电子设备 | ||
1.一种机器人的弹跳控制方法,其特征在于,所述方法包括:
基于机器人的运动轨迹的优化变量,构建所述机器人的代价函数,所述代价函数用于表征所述机器人在连续跳跃过程中至少一次从跳起时到落地时的运动轨迹;
将所述代价函数在优化器中解算,得到所述机器人在落地时对应的预期质心位置、预期落足点、预期地面接触反力;
根据所述预期质心位置与所述预期落足点,确定所述机器人落地时的着地角;
获取所述机器人落地时对应的实际质心位置;
根据所述着地角与所述实际质心位置,确定所述机器人落地时的足端期望位置;
将所述足端期望位置和所述实际质心位置通过逆解计算,确定所述机器人的关节角度;
根据所述预期落足点与所述关节角度,对所述机器人进行控制,使所述机器人落地的时足端达到所述预期落足点,以及控制电机产生第一作用力,所述第一作用力与所述预期地面接触反力大小相等,方向相反。
2.根据权利要求1所述的方法,其特征在于,所述机器人的代价函数通过如下公式表达:
其中,x,f,Pj表示优化变量,k表示预观时域,xi表示当前时刻机器人质心的运动状态,xi,ref表示机器人质心运动状态的参考值,Qr表示质心状态的权重,fi表示当前时刻地面的接触反力,Qf表示对地面接触反力的权重,Pi表示当前时刻的落足点,Pi,ref表示期望的落足点,QP表示机器人落足点的权重。
3.根据权利要求1所述的方法,其特征在于,所述将所述代价函数在优化器中解算,得到所述机器人在落地时对应的预期质心位置、预期落足点、预期地面接触反力,包括:
获取机器人的运动轨迹的约束条件;
基于所述约束条件,通过优化器解算所述代价函数,得到所述机器人在落地时对应的预期质心位置、预期落足点、预期地面接触反力。
4.根据权利要求1所述的方法,其特征在于,所述根据所述预期质心位置与所述预期落足点,确定所述机器人落地时的着地角,包括:
构建所述预期质心位置与所述预期落足点的连线;
基于所述连线,将地面垂直方向与所述连线的夹角作为机器人落地时的着地角。
5.根据权利要求1所述的方法,其特征在于,机器人落地时的着地角通过如下公式表达:
其中,α表示着地角,Px表示预期落足点的x轴方向位置,Pz表示预期落足点的z轴方向位置,rx表示预期质心的x轴方向位置,rz表示预期质心的z轴方向位置。
6.根据权利要求1所述的方法,其特征在于,所述根据所述着地角与所述实际质心位置,确定所述机器人落地时的足端期望位置,包括:
获取机器人落地时对应的实际足端位置;
确定所述实际质心位置与所述实际足端位置的距离;
根据所述距离、所述着地角与所述实际质心位置,确定所述机器人落地时的足端期望位置。
7.根据权利要求1所述的方法,其特征在于,所述机器人落地时的足端期望位置通过如下公式表达:
其中,表示期望的足端z轴方向位置,表示期望的足端x轴方向位置,rx′表示实际质心的x轴方向位置,rz′表示实际质心的z轴方向位置,I表示实际质心位置与实际足端位置的距离,α表示着地角。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于乐聚(深圳)机器人技术有限公司,未经乐聚(深圳)机器人技术有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202310115209.1/1.html,转载请声明来源钻瓜专利网。





